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SOFTWARE  AND  HARDWARE  DESCRIPTION  OF  THE  HELICOPTER  MOTION  EQUATIONS 


FOR  VAX  COMPUTERS 


INTRODUCTION 


The  U.S.  Army  Human  Engineering  Laboratory  (HEL)  at  Aberdeen  Proving  Ground, 
Maryland,  is  the  U.S.  Army  Laboratory  Command's  lead  laboratory  for  human  factors 
engineering.  Increasingly  sophisticated  equipment  and  soldier  interfaces  require 
the  laboratory  to  perform  effective  investigations  of  complex  soldier-machine 
interfaces . 
x 

)  The  Human  Factors  Cockpit  Research,  Experimentation,  and  Workload  (CREW) 
Simulator  is  a  fixed  base,  generic  helicopter  simulator  that  provides  the 
flexibility  to  explore  state-of-the-art  aircrew/display/control  interaction.  The 
CREW  simulator  involves  four  major  components:  the  visual  system,  the  graphics 
system,  the  data  collection,  and  the  flight  equations.  HEL  uses  the  UH60 
Blackhawk  version  of  the  standard  -  kinematic  equations  for  an ■ aircraft  (herein 
called  HAC  equations)  when  conducting  experiments  on  the  CREW  simulator.  s 


The  HAC  equations  were  acquired  from  NASA  Ames,  in  Mountain  View, 
California,  with  the  objective  of  simulating  aerodynamic  characteristics  of  a 
helicopter  in  a  part- task  simulator  for  human  factors  studies  related  to  displays 
and  controls.  The  HAC  equations  also  allow  us  to  simulate  nap-of-the-earth  (NOE) 
f light The  HAC  equations  are  based  on  the  second-order  Adams -Bashford  predictor 
integration  method  and  the  modified  Euler  algorithm.  They  do  not  model  the 
engi«Xor  rotor  systems  of  the  helicopter. 


— -pThis  report  describes  the  software  design  and  the  hardware  configuration 
used  to  execute  the  HAC  equations  on  a  MicroVAX  II  VAXLab  computer  under  the  VMS 
operating  system  using  VAX  FORTRAN.  The  HAC  equations  are  not  described  in 
detail  in  this  report.  For  more  detailed  information,  r  -far  to  McFarland  (1975). 

.  The  objective  of  this  report  is  to  provide  internal  documentation  and  also  to 
provide  a  description  of  design  for  others  desiring  to  implement  these  or  similar 
equations  of  motion  under  the  VAX/VMS  (Virtual  Address  eXtension/Virtual  Memory 


System)  operating  system  in  a  real-time1,  manned,  interactive  simulation. 


} 


SYSTEM  DESCRIPTION 


Hardware  Configuration 

The  HAC  equations  are  run  on  a  Digital  Equipment  Corporation  MicroVAX  II 
VAXLab  with  5.0  megabytes  (MB)  of  memory.  The  following  hardware  devices,  which 
are  interfaced  to  the  MicroVAX  II  VAXLab,  are  used  for  the  HAC  equations: 


^eal -  time  in  simulation  is  executing  a  process  at  a  speed  fast  enough  to  give  a 
response  within  the  actual  time  of  the  real  event. 
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•  ADV11-DA  digital- to -analog  converter 

•  DRV11-W  communications  board 

•  conventional  helicopter  controls  and  four-axis  controls 

The  output  from  the  HAC  equations  is  sent  to  the  VAX  11/780  for  cockpit 
out- the -window  visuals  and  from  the  VAX  11/780  to  the  VAX  11/750  for  graphics 
displays  and  performance  data  collection.  The  MicroVAX  II  VAXLab  uses  an 
Ethernet/DECnet  communications  network  to  start  processes  for  visuals  and 
displays  on  the  VAX  11/780  and  the  VAX  11/750.  Figure  1  shows  a  general  picture 
of  the  hardware  configuration  of  the  system  (Herald,  1987). 


Software  Configuration 

The  HAC  equations  are  run  under  the  MicroVAX  VMS  Version  4.4  operating 
system.  The  source  programs  for  the  HAC  equations  are  written  in  the  VAX  FORTRAN 
language  Version  5.0  (Digital  Equipment  Corporation,  1984)  except  for  two  modules 
written  in  VAX  MACRO. 

Four  processes2  are  executed  simultaneously  when  running  the  HAC  equations. 
Therefore,  priorities  need  to  be  set  to  determine  the  order  in  which  these 
executable  processes  are  to  run.  The  four  processes  are  START_HACSEC ,  which, 
creates  the  global  section;  AD30HZ,  which  reads  the  analog  values  from  the 
cockpit  controls  and  digitizes  their  values;  HACMAIN_BH,  which  executes  the  MAC 
equations;  and  DR1 1_SND_RCV ,  which  transmits  the  outputs  to  the  VAX/780.  Figur  ■ 
2  shows  the  system  when  the  processes  are  running.  In  general  32%  of  the  central 
processing  unit  (CPU)3  time  on  the  MicroVAX  II  VAXLab  is  used. 

All  processes  use  the  VAX  system  services  to  create  and  map  the  global 
section,  to  control  the  execution  speed  of  the  process,  and  to  communicate 
between  processes  through  event  flags.  System  services  are  procedures  that  the 
VAX/VMS  operating  system  uses  to 

•  control  re  es  available  to  processes; 

•  provide  for  ■  uunication  among  processes;  and 

•  perform  basic  at.ing  system  functions,  such  as  the 

coordination  ••  'output  operations. 


GLOBAL  SECTION  DESCRIPTION 


A  global  section  is 
shareable  code  or  data, 
file. 


ether  a  ',;sk  file  or  a  page  -file  section  contain.-.;; 
1...  global  j.i'tion  referenced  in  this  report  is  a  disk 


A  process  is  the  execution  1  program  image. 

3CPU  time  is  the  amount  of  tin  CPU  consumed  by  the  program  wh.-n  it  executed 
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Figure  1.  Hardware  configuration. 
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Firure  2,  Software  conf igura t i on . 
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The  following  characteristics  apply  to  the  global  section: 

a.  The  starting  and  ending  virtual  addresses  are  the  address  of  the 
variable  ARM(l)  and  the  address  of  the  variable  WAYPT_ERR,  respectively. 

b.  The  global  section  is  set  up  as  a  temporary  group  global  section, 
with  read  and  write  access  to  the  pages,  and  all  pages  initialized  to  zero  when 
created. 

c.  The  global  section's  name  is  HACSEC. 

d.  The  name  of  the  disk  file  opened  to  map  the  pages  is  HACSEC.DAT. 

VAX  FORTRAN  common  statements  are  used  in  all  source  programs  for  the  HAC 
equations  to  arrange  the  variables  in  the  global  section  HACSEC.  A  common 
statement  defines  one  or  more  contiguous  areas,  or  blocks  of  storage.  Common 
statements  also  define  the  order  in  which  variables  and  arrays  are  stored  in  each 
common  block.  Appendix  A  lists  the  source  code  that  has  all  commons  included  in 
the  four  programs,  which  are  START_HACSEC ,  AD30HZ,  DR11_SND_RCV  and  HACMAIN_BH. 


PROCESS  DESCRIPTIONS 

STARTHACSEC  Process 
Description 

The  STARTHACSEC  process  is  responsible  for  creating  and  mapping  to 
the  global  section  HACSEC  shared  by  HACMAIN_BH ,  AD30HZ ,  and  DR11_SND_RCV 
processes . 


The  STARTHACSEC  process  runs  only  once  and  suspends  itself,  thus 
keeping  the  global  section  in  memory  and  accessible  to  the  other  processes  for 
mapping.  This  technique  is  useful  in  making  HACMAIN_BH,  AD30HZ,  and  DR11_SND_RCV 
processes  independent  of  each  other  allowing  individual  process  priorities  and 
scheduling.  The  process  is  kept  at  a  non- real - time  priority  4  and  is  the  first 
one  to  run.  The  listing  of  the  source  code  is  in  Appendix  B. 

Outnut 

The  output  to  this  process  is  the  created  global  section  with  all  the 
variables  that  appear  in  the  include  files4  listed  in  Appendix  A. 


*An  include  file  is  a  module  of  source  text  that  can  be  incorporated  into  a 
FORTRAN  program  by  using  the  INCLUDE  FORTRAN  statement. 
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AD30HZ  Process 


Description 

The  AD30HZ  process  is  responsible  for  controlling  the  analog- to- 
digital  converter  and  converting  analog  values  from  the  cockpit  controls  to 
digital  values.  The  AD30HZ  process  uses  the  synchronous  user  interface  LIO$READ 
from  SYS$LIBRARY: LIOSET . FOR  symbol  definitions.  The  process  runs  at  real-time 
priority  20.  The  process  reads  the  analog  values  for  16  channels  via  the  ADV11 
interface  30  times  every  second  and  puts  the  values  in  a  buffer  from  which  only 
four  channels  are  put  in  the  global  section  HACSEC.  The  four  channels  used 
represent  pitch,  roll,  collective  and  pedals  digital  outputs.  Pitch  and  roll 
analog  values  come  from  the  four-axis  controller  interface;  the  collective  and 
pedals  analog  values  come  from  the  conventional  helicopter  collective  and  pedals 
controls.  The  remaining  12  channels  are  not  presently  used. 

The  AD30HZ  process  is  also  responsible  for  controlling  the  processing 
speed  of  HACMAIN__BH  and  DR11_SND_RCV  through  event  flags  96  and  97  respectively 
on  VAX  cluster  3.  This  technique  is  used  to  optimize  the  CPU  time  used  by  the 
processes  and  at  the  same  time  it  assures  sending  the  latest  values  to  the  VAX 
11/780  for  processing.  The  listing  of  the  source  code  appears  in  Appendix  B. 

Input 

The  four  values  read  from  the  analog  channels  serve  as  the  input  to 
this  process. 


Output 

The  four  digital  values  are  put  in  the  global  section  through  the 
variable  CHAD. 


DR1 1_SND_RCV  Process 
Description 

The  DR1 1_SND_RCV  process  is  responsible  for  sending  the  v.l  ues 
computed  by  HACMA1N  BH  eq  ■!  ions  to  the  VAX  11/780.  The  process  runs 
real-time  priority  18.  The  values  are  obtained  from  the  glrbai  section  liACjr.o 
and  are  sent  via  the  DR11W  interface  13  times  every  second.  The  valut s  that  are 
sent  to  the  VAX  11/780  are  used  to  update  the  visual  system.  The  listing  e .'  the 

main  program  source  code  appears  in  Appendix  B. 

DR11_SND_RCV  is  divided  into  the  following  MACRO  and  rORTP 
subroutines5 : 


5A  FORTRAN  subroutine  is  a  [  ’ram  unit  consisting  of  a  SUBROUTINE  statement 
followed  by  a  series  of  scat.  i.  nts  that  define  a  computing  procedure.  A  CALL 
statement  is  used  to  transfer  ontrol  to  a  subroutine  and  a  RETURN  statement  is 
used  to  return  cont.ol  to  the  calling  program  unit. 
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•  UPDATE_TO_VAX- -Updates  variables  that  are  going  to  be  sent  to 

the  VAX  11/780 

•  UPDATE_FROM_VAX- -Updates  variables  with  values  sent  from  the  VAX 

11/780 

•  DRll_SND_RCV- -Sends  and  receives  values  from  or  to  the  VAX 

11/780 

•  XALINK  and  XAMESSAGE- - Interface  with  DR11  drivers6  using  DEC 
MACRO  subroutines 

The  DR11_SND_RCV  process  loops  through  the  above  modules  1 S  times 
every  second  controlled  by  the  AD30HZ  process  through  event  flag  97.  The 
listings  of  the  MACRO  and  FORTRAN  subroutines  are  in  Appendix  C. 


Input 

The  values  that  serve  as  input  are  airspeed  (UB) ,  torque  (QRAPCT) , 
altitude  (ALT),  rate  of  climb  (ALTD) ,  pitch  in  radians  (THETR) ,  pitch  in  degrees 
(THET)  ,  roll  in  radians  (PHIR) ,  roll  in  degrees  (PHI),  yaw  in  radians  (PSIR) , 
roll  in  degrees  (PSI),  cosine  and  sine  of  roll  (CPHI  and  SPHI)  ,  velocity  east 
(VE) ,  and  velocity  north  (VN) . 


Output 

The  same  values  that  serve  as  input  are  also  output. 


HACMAIN  BH  Process 


Description 

The  HACMAIN_BH  process  is  responsible  for  running  the  HAC  equations. 
The  equations  are  based  on  the  second-order  Adams -Bashford  predictor  integration 
method  and  the  modified  Euler  algorithm. 

All  axis  systems  are  orthogonal7,  right-handed  triads.  The  axis 
systems  used  in  the  equations  are  the  Earth  frame  (E- frame),  the  Local  frame 
(L- frame),  and  the  Body  frame  (B- frame). 

The  E- frame  is  an  inertial  frame  with  the  origin  of  the  coordinates  at 
the  Earth's  center;  the  Zg  axis  intersects  the  North  Pole,  and  the  Xg  axis 
intersects  the  zero-degree  longitude  line  (Greenwich)  at  "zero  time.”  The 
L-frame  is  situated  on  the  Earth's  surface,  directly  under  the  vehicle.  Its  X^ 
axis  points  northward  and  its  axis  points  eastward;  both  are  parallel  to  the 

A  device  driver  is  a  set  of  routines  and  tables  that  the  system  uses  to  process 
an  input/output  request  for  a  particular  device  type, 
intersecting  or  lying  at  right  angles. 
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Earth's  surface.  The  Z ^  axis  points  toward  the  Earth's  center.  The  L- frame 
follows  the  motion  of  the  aircraft  but  its  distance  from  the  center  of  the  Earth 
is  constant.  The  B-frame  uses  the  conventional  aircraft  no*"°tion;  the  axis 
passes  through  the  nose  of  the  vehicle,  the  axis  points  toward  the  right  wing, 
a. id  the  Z^  axis  passes  through  the  bottom  of  the  vehicle.  The  B-frame  origin  is 
located  at  the  vehicle's  center  of  gravity.  The  listing  of  the  main  program  is 
in  Appendix  B. 

HACMAIN_BH  is  divided  into  the  following  subroutines  (The  listings  of 
these  subroutines  are  in  Appendix  C.): 

•  HACDATA- - Initializes  the  values 

•  SCALEAD- -  Scales  the  analog-to-digital  values  read  by  the  AD30HZ 

process 


•  SMART- -Solves  the  force  components  in  Earth  frame,  altitude, 
accelerations,  velocities,  rotational  rates,  Euler  angles,  eyepoint  position, 
turbulence,  and  airspeed 

•  CONTRL- -  Provides  for  helicopter  controls 

•  FAM- -  Provides  helicopter  forces,  accelerations,  and  moments 
including  aero,  engine,  and  part  of  the  equations  of  motion.  It  calculates 
target  rotational  accelerations,  total  translational  forces  on  the  vehicle  and 
Limits  calculations  for  Z  force 

•  BEEPER- -Provides  a  trim  routine 

The  HACMA1N_BH  process  loops  through  the  above  modules  30  times  every  second 
controlled  by  the  AD30HZ  process  through  event  flag  96.  It  runs  at  real-time 
priority  19. 


Input 


The  same  four  c  ;annels  (pitch,  roll,  collective,  and  pedals)  that  are 
output  from  the  AD30HZ  process  (CHAD)  are  output  for  the  HACMAIN_BH  process. 


Output 


The  values  that  serve  as  output  are  airspeed  (UB) ,  torque  (QRAPCT) , 
altitude  (ALT),  rate  of  climb  (ALTD) ,  pitch  in  radians  (THETR) ,  pitch  in  degrees 
(THET) ,  i  oil  in  radians  (PHIR) ,  roll  in  degrees  (PHi),  yaw  in  radians  (PSIR), 
in  degrees  (PSI),  cosine  and  sine  of  roll  (CPHT  and  S  PH  I )  ,  velocity  cast 
(VE)  ,  and  velocity  north  L 


SEQUENCE  DESCRIPTION 

TLie  first  process  to  1»  run  is  START_HACSEC  since  it  creates  the  global 
section  HACSEC  for  the  other  three  processes.  Once  the  global  section  is 
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created,  the  other  three  processes  may  start  running  in  any  order.  It  is  a  good 
idea  to  run  the  process  with  the  lowest  priority  first  to  make  sure  it  is  created 
with  no  delay.  Following  this,  the  order  would  be  DR11_SND_RCV  with  priority  18, 
HACMAIN_BH  with  priority  19,  and  AD30HZ  with  priority  20.  DR11_SND_RCV  and 
HACMAIN_BH  will  not  start  looping  through  the  program  until  AD30HZ  starts  running 
and  setting  the  respective  event  flags. 


CONCLUSIONS 

The  HAC  equations  software  arranged  in  four  modules  makes  it  easier  for  the 
user  to  make  modifications.  These  modules  may  be  used  separately  on  other 
applications  since  they  are  written  in  a  general  form. 

When  running  the  HAC  equations  software  on  the  VAXLab ,  only  32X  of  the  CPU 
is  used.  This  gives  68X  of  the  CPU  time  to  run  other  HEL  applications  for 
testing  without  affecting  the  performance  of  the  equations. 

Using  more  than  one  computer  to  perform  investigations  of  complex 
soldier-machine  interfaces  is  an  approach  taken  by  HEL  to  support  the  wide  range 
of  tasks  for  the  simulation  needs  and  to  allow  for  easy  growth  at  a  low  initial 
cost . 
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APPENDIX  A 

INCLUDE  FILES  SOURCE  CODE 


15 


HAC1.INC 


C*********************************************************************** 

C  SIGNIFICANT  VARIABLES 

C**************************************************************1^******* 

c 

c 

C  3  12  20  63 

C  VARIABLF  COMMON  . D  E  F  I  N  I  T  I  0  N .  UNITS 

C  NAME  ARRAY 

C  LOCATION 

C 
C 

C  >>>>  INPUT  <<<< 

C  . - . . 

c 

c 

c 


c 

SPHI 

A( 

10) 

SINE  OF  EULER  ROLL  ANGLE 

NONE 

c 

CPHI 

A( 

ID 

COSINE  OF  EULER  ROLL  ANGLE 

NONE 

c 

STHT 

A( 

12) 

SINE  OF  EULER  PITCH  ANGLE 

NONE 

c 

CTHT 

A( 

13) 

COSINE  OF  EULER  PITCH  ANGLE 

NONE 

c 

SPSI 

A( 

14) 

SINE  OF  EULER  YAW  ANGLE 

NONE 

c 

CPSI 

A( 

15) 

COSINE  OF  EULER  YAW  ANGLE 

NONE 

c 

Til 

A( 

16) 

CTHT*CPSI 

NONE 

c 

T21 

A( 

17) 

SPHI*STHT*CPSI  -  CPHI*SPSI 

NONE 

c 

T31 

A( 

18) 

CPHI*STHT*CPSI  +  SPHI*SPSI 

NONE 

c 

T12 

A( 

19) 

CTHT*SPSI 

NONE 

c 

T22 

A( 

20) 

SPHI*STHT*SPSI  +  CPHI*CPSI 

NONE 

c 

T32 

A( 

21) 

CPHI*STHT*SPSI  -  SPHI*CPS1 

NONE 

c 

T13 

A( 

22) 

-  STHT 

NONE 

c 

T23 

A( 

23) 

SPHI*CTHT 

NONE 

c 

T33 

A( 

24) 

CPHI*CTHT 

NONE 

c 

PB 

A( 

37) 

AIRCRAFT  ROLL  VELOCITY,  B- FRAME 

RAD/S 

c 

QB 

A( 

38) 

AIRCRAFT  PITCH  VELOCITY,  B- FRAME 

RAD/S 

c 

RB 

A( 

39) 

AIRCRAFT  YAW  VELOCITY,  B- FRAME 

RAD/S 

c 

PLB 

A( 

43) 

INSTANTANEOUS  ROLL  RATE,  B- FRAME 

RAD/S 

c 

QLB 

A( 

44) 

INSTANTANEOUS  PITCH  RATE,  B- FRAME 

RAD/S 

c 

RLB 

A( 

45) 

INSTANTANEOUS  YAW  RATE,  B- FRAME 

RAD/S 

c 

PTURB 

A( 

52) 

TURB.  AND  EFFECTS  CONTRIB.  TO  ROLL  R. 

RAD/S 

C  QTURB 

A( 

53) 

TURB.  AND  EFFECTS  CONTRIB.  TO  PITCH  R. 

RAD/S 

C 

RTURB 

A( 

54) 

TURB.  AND  EFFECTS  CONTRIB.  TO  YAW  R. 

RAD/S 

C 

VN 

A( 

64) 

NORTHWARD  VEL.  OVER  EARTH'S  SUR. ,  L- FRAME 

F/S 

C 

VE 

A( 

65) 

EASTWARD  VEL.  OVER  FIXED  EARTH,  L- FRAME 

F/S 

r> 

O 

VD 

A( 

66) 

DOWNWARD  VEL.  TOWARD  EARTH'S  CEN.,  L- FRAME 

F/S 

c 

VNW 

A( 

76) 

NORTH  COMPONENT  OF  WIND  VELOCITY  (RMS) 

F/S 

c 

VEW 

A( 

77) 

EAST  COMPONENT  OF  WIND  VELOCITY  (RMS) 

F/S 

c 

VDW 

A( 

78) 

DOWNWARD  COMPONENT  OF  WIND  VELOCITY  (RMS) 

F/S 

c 

RR 

A(108) 

RADIUS  OF  EARTH  +  HEIGHT  OF  RUNWAY 

FT 

c 

XLATR 

A( 111) 

LATITUDE  OF  THE  RUNWAY 

RAD 

c 

XLONR 

A( 112) 

LONGITUDE  OF  THE  RUNWAY 

RAD 

c 

CLATR 

A(113) 

COSINE  OF  THE  RUNWAY  LATITUDE 

NONE 

c 

STHETR 

A( 114) 

SINE  OF  RUNWAY  ANGLE 

NONE 

c 

CTHETR 

A( 115) 

COSINE  OF  RUNWAY  ANGLE 

NONE 
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c 

XMC(l) 

A(120) 

( (XIYY-XIZZ)*XIZZ-XIXZ**2 ) /(XIXX*XIZZ*XIXZ**2 )  NONE 

c 

XMC(2) 

A(121) 

(XIXX-XIYY+XIZZ)*XIXZ/(XIXX*XIZZ-XIXZ**2) 

NONE 

c 

XMC(3) 

A(122) 

XIZZ/(XIXX*XIZZ-XIXZ**2) 

NONE 

c 

XMC(4) 

A(123) 

XIXZ/(XIXX*XIZZ-XIXZ**2) 

NONE 

c 

XMC(5) 

A(124) 

(XIZZ-XIXX) /XIYY 

NONE 

c 

XMC(6) 

A(125) 

XIXZ/XIYY 

NONE 

c 

XMC(7) 

A( 126) 

1 .  /XIYY 

NONE 

c 

XMC(8) 

A(127) 

((XIXX-XIYY)*XIXX*XIXZ**2)/(XIXX*XIZZ-XIXZ**2)  NONE 

c 

XMC(9) 

A(128) 

(XIYY-XIZZ-XIXX)*XIXZ/(XIXX*XIZZ-XIXZ**2) 

NONE 

c 

XMC(IO) 

A(129) 

XIXX/(XIXX*XIZZ-XIXZ**2) 

NONE 

c 

XMASS 

A( 130) 

MASS  OF  VEHICLE  (INCLUDING  FUEL) 

SLUGS 

c 

FAX 

A(136) 

AERODYNAMIC  X- FORCE 

LBS 

c 

FAY 

A(137) 

AERODYNAMIC  Y- FORCE 

LBS 

c 

FAZ 

A(138) 

AERODYNAMIC  Z- FORCE 

LBS 

c 

FEX 

A( 139) 

ENGINES  X- FORCE 

LBS 

c 

FEY 

A( 140) 

ENGINES  Y- FORCE 

LBS 

c 

FEZ 

A(141) 

ENCINES  Z- FORCE 

LBS 

c 

FGX 

A(142) 

LANDING  GEARS  X- FORCE 

LBS 

c 

FGY 

A(143) 

LANDING  GEARS  Y- FORCE 

LBS 

c 

FGZ 

A( 144) 

LANDING  GEARS  Z- FORCE 

LBS 

c 

TAL 

A(155) 

AERODYNAMIC  ROLLING  MOMENT  COMPONENT 

F-LBS 

c 

TAM 

A(156) 

AERODYNAMIC  PITCHING  MOMENT  COMPONENT 

F-LBS 

c 

TAN 

A(157) 

AERODYNAMIC  YAWING  MOMENT  COMPONENT 

F-LBS 

c 

TEL 

A(  158) 

ENGINE  ROLLING  MOMENT  COMPONENT 

F-LBS 

c 

TEM 

A(  159 ) 

ENGINE  PITCHING  MOMENT  COMPONENT 

F-LBS 

c 

TEN 

A( 160) 

ENGINE  YAWING  MOMENT  COMPONENT 

F-LBS 

c 

TGL 

A(  161 ) 

LANDING  GEARS  ROLLING  MOMENT  COMPONENT 

F-LBS 

c 

TGM 

A(162) 

LANDING  GEARS  PITCHING  MOMENT  COMPONENT 

F-LBS 

c 

TGN 

A(163) 

LANDING  GEARS  YAWING  MOMENT  COMPONENT 

F-LBS 

c 

DT2 

A(168) 

SECOND  LOOP  TIME  FRAME  (MEDIUM) 

S 

c 

HR 

A( 170) 

HEIGHT  OF  RUNWAY  W/R/T  SEA  LEVEL 

FT 

c 

XP 

A( 171) 

X  POSITION  OF  PILOT  W/R/T  C.G. 

FT 

c 

YP 

A(  172 ) 

V  POSITION  OF  PILOT  W/R/T  C.G. 

FT 

c 

ZP 

A(173) 

Z  POSITION  OF  PILOT  W/R/T  C.G. 

FT 

c 

WAIT 

A(  177 ) 

AIRCRAFT  GROSS  WEIGHT 

LB 

c 

SOUNDZ 

A(293) 

SPEED  OF  SOUND  AT  SEA  LEVEL 

F/S 

c 

RE 

A(336) 

RADIUS  OF  EARTH 

FT 

c 

REINV 

A( 337) 

INVERSE  OF  RE 

1/F 

c 

OMEG 

A( 347) 

EARTH'S  ROTATION  RATE 

RAD/S 

c 

R2D 

A(359) 

57.2957795 

DEG/RAD 

c 

DELAT 

A(370) 

DELTA  AMBIENT  TEMPERATURE 

DEG  K 

c 

XMCC1 

A(375) 

XMC4*EXMX  -  XMC3*EXMX  (ROTATING  ENGINES) 

1/S 

c 

XMCC2 

A(  376) 

XMC7*EXMX  (ROTATING  ENGINES) 

1/S 

c 

XMCC3 

A( 377) 

XMC7*EXMZ  (ROTATING  ENGINES) 

1/S 

c 

XMCC4 

A(378) 

XMC10*EXMX  -  XMC4*EXMZ( ROTATING  ENGINES) 

1/S 

c 

XMCC5 

A(379) 

XMC3*FXMY  (ROTATING  ENGINES) 

1/S 

c 

XMCC6 

A( 380) 

XMC4*F.XMY  (ROTATING  ENGINES) 

1/S 

c 

XMCC7 

A( 381) 

XMC10* EXMY  (ROTATING  ENGINES) 

i/s 

c 

c 

TLAT 

A(426) 

TANGENT  OF  AIRCRAFT  LATITUDE 

NONE 

c 

IMODE 

IA(  1) 

MODE  CONTROL  INTEGER  (NEC:IC,  0 : HLD ,  POS:< 

OP) 

c 

I  PLAT 

IA(  6) 

FLAT  EAR  1  ii  OPTION 

c 

IFFCI 

IA(  7) 

DISABLE  TRANSLATIONAL  DEGREES  OF  FREEDOM 

c 

IETURB 

IA(185) 

TURB.  GENERATED  IN  EARTH ( 1 )  OR  BODY(O)  FRAME 
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non 


C  ITOMTR  IA( 187)  ZERO  ALFD  AND  BETD  IN  IC 

C  IFREEZ  IA(200)  FREEZE  TRANSLATIONAL  &  ROTATIONAL  MOTION  OF  A.C. 


C  >>>>  OUTPUT  <<<< 

C  . - . 

c 

c 

c 


c 

PHI 

A( 

1) 

ROLL  EULER  ANGLE,  L- FRAME 

DEG 

c 

THET 

A( 

2) 

PITCH  EULER  ANGLE,  L- FRAME 

DEG 

c 

PSI 

A( 

3) 

YAW  EULER  ANGLE,  L- FRAME 

DEG 

c 

PHIR 

A( 

4) 

ROLL  ANGLE,  L- FRAME 

RAD 

c 

THETR 

A( 

5) 

PITCH  ANGLE,  L- FRAME 

RAD 

c 

PSIR 

A( 

6) 

YAW  ANGLE,  L- FRAME 

RAD 

c 

PHID 

A( 

7) 

ROLL  RATE,  L- FRAME 

RAD/S 

c 

THED 

A( 

8) 

PITCH  RATE,  L- FRAME 

RAD/S 

c 

PSID 

A( 

9) 

YAW  RATE,  L- FRAME 

RAD/S 

c 

ALFA 

A( 

25) 

ANGLE  OF  ATTACK 

DEG 

c 

BETA 

A( 

26) 

SIDESLIP  ANGLE 

DEG 

c 

ALFAR 

A( 

27) 

ANGLE  OF  ATTACK 

RAD 

c 

BETAR 

A( 

28) 

SIDESLIP  ANGLE 

RAD 

c 

ALFD 

A( 

29) 

ANGLE  OF  ATTACK  RATE 

RAD/S 

c 

BETD 

A( 

30) 

SIDESLIP  ANGLE  RATE 

RAD/S 

c 

SALPH 

A( 

31) 

SINE  OF  ANGLE  OF  ATTACK 

NONE 

c 

CALPH 

A( 

32) 

COSINE  OF  ANGLE  OF  ATTACK 

NONE 

c 

SBETA 

A( 

33) 

SINE  OF  SIDESLIP  ANGLE 

NONE 

c 

CBETA 

A( 

34) 

COSINE  OF  SIDESLIP  ANGLE 

NONE 

c 

GAMV 

A( 

35) 

FLIGHT  PATH  ANGLE  ABOVE  HORIZON 

RAD 

c 

GAMH 

A( 

36) 

FLIGHT  PATH  ANGLE  IN  HORIZON  FRAME 

RAD 

c 

PL 

A( 

40) 

INSTANTANEOUS  ROLL  RATE,  L- FRAME 

RAD/S 

c 

QL 

A( 

41) 

INSTANTANEOUS  PITCH  RATE,  L- FRAME 

RAD/S 

c 

RL 

A( 

42) 

INSTANTANEOUS  YAW  RATE,  L- FRAME 

RAD/S 

c 

PT 

A( 

46) 

TOTAL  ROLL  RATE,  L- FRAME 

RAD/S 

C  QT 

A( 

47) 

TOTAL  PITCH  RATE,  L- FRAME 

RAD/S 

c 

RT 

A( 

48) 

TOTAL  YAW  RATE,  L- FRAME 

RAD/S 

c 

PBWN 

A( 

49) 

ROLL  RATE,  B- FRAME 

RAD/S 

c 

QBWN 

A( 

50) 

PITCH  RATE,  B- FRAME 

RAD/S 

c 

RBWN 

A( 

51) 

YAW  RATE,  B- FRAME 

RAD/S 

c 

PBD 

A( 

55) 

AIRCRAFT  ROLL  ACCELERATION,  B- FRAME 

RAD/S 2 

C  QBD 

A( 

56) 

AIRCRAFT  PITCH  ACCELERATION,  B- FRAME 

RAD/S 2 

C 

RBD 

A( 

57) 

AIRCRAFT  YAW  ACCELERATION,  B- FRAME 

RAD/S 2 

c 

UB 

A( 

58) 

X  VELOCITY  (FORWARD),  B-FRAME 

F/S 

c 

VB 

A( 

59) 

Y  VELOCITY  (RIGHTWARD),  B-FRAME 

F/S 

c 

WB 

A( 

60) 

Z  VELOCITY  (DOWNWARD),  B-FRAME 

F/S 

c 

UTURB 

A( 

61) 

X  VELOCITY  TURBULENCE  COMPONENT,  B-FRAME 

F/S 

c 

VTURB 

A( 

62) 

Y  VELOCITY  TURBULENCE  COMPONENT,  B-FRAME 

F/S 

c 

WTURB 

A( 

63) 

Z  VELOCITY  TURBULENCE  COMPONENT 

F/S 

c 

VEE 

A( 

67) 

EASTWARD  VELOCITY  OVER  ROTATING  EARTH 

F/S 

c 

VT 

A( 

68) 

TOTAL  VELOCITY,  L- FRAME 

F/S 

c 

VG 

A( 

69) 

GROUND  SPEED,  L- FRAME 

F/S 

c 

VRW 

A( 

70) 

VELOCITY  W/R/T  WIND 

F/S 

c 

VNR 

A( 

72) 

NORTH  RELATIVE  VELOCITY 

F/S 

C  VER 
C  VDR 
C  VEQ 
C  ALTD 
C  XLOND 
C  XLATD 
C  ALT 
C  XLON 
C  XLAT 
C  SLAT 
C  CLAT 
C  VND 
C  VED 
C  VDD 
C  AX 
C  AY 
C  AZ 
C  AXP 
C  AYP 
C  AZP 
C  G 

C  VCAL 
C  XPR 
C  YPR 
C  HPR 
C  DNR 
C  DER 
C  RTV 
C  FTX 
C  FTY 
C  FTZ 
C  FN 
C  FE 
C  FD 
C  FG 
C  TTL 
C  TTM 
C  TTN 
C  XCG 
C  YCG 
C  HCG 
C  QBAR 
C  CBARC 
C  RHO 
C  SOUND 
C  TIME 
C  TR 
C  PR 
C  RHOZ 
C  TAMB 
C  PAMB 
C  TTOT 
C  PTOT 
C  UBD 


A(  73)  EASTWARD  RELATIVE  VELOCITY  F/S 

A(  74)  DOWNWARD  RELATIVE  VELOCITY  F/S 

A(  75)  EQUIVALENT  AIRSPEED  KNOTS 

A(  80)  ALTITUDE  RATE  OF  CHANGE  F/S 

A(  81)  LONGITUDE  RATE  OF  CHANGE  RAD/S 

A(  82)  LATITUDE  RATE  OF  CHANGE  RAD/S 

A(  83)  ALTITUDE  OF  AIRCRAFT  ABOVE  SEA  LEVEL  F 

A(  84)  LONGITUDE  OF  AIRCRAFT  RAD 

A(  85)  LATITUDE  OF  AIRCRAFT  RAD 

A(  86)  SINE  OF  AIRCRAFT  LATITUDE  NONE 

A(  87)  COSINE  OF  AIRCRAFT  LATITUDE  NONE 

A(  88)  NORTHWARD  ACCELERATION  OVEfc  EARTH,  L- FRAME  I'/S2 

A(  89)  EASTWARD  ACCELERATION  OVER  EARTH,  L- FRAME  F/S2 

A(  90)  DOWNWARD  ACCELERATION  TOWARD  EARTH  CENTER  F/S2 

A(  91)  X  ACCELERATION  OF  AIRCRAFT  C.G.,  B-FRAME  F/S2 

A(  92)  Y  ACCELERATION  OF  AIRCRAFT  C.G.,  B-FRAME  F/S2 

A(  93)  Z  ACCELERATION  OF  AIRCRAFT  C.G.,  B-FRAME  F/S2 

A(  94)  X  ACCELERATION  OF  PILOT,  B-FRAME  F/S2 

A(  95)  Y  ACCELERATION  OF  PILOT,  B-FRAME  F/S2 

A(  96)  Z  ACCELERATION  OF  PILOT,  B-FRAME  F/S2 

A(  97)  ACCERATION  DUE  TO  GRAVITY  (AT  ALTITUDE)  F/S2 

A(101)  CALIBRATED  AIRSPEED  KNOTS 

A(103)  DISTANCE  OF  PILOT  DOWN  RUNWAY  F 

A (104)  DISTANCE  OF  PILOT  TO  THE  RIGHT  OF  RUNWAY  F 

A (105)  HEIGHT  OF  PILOT  ABOVE  RUNWAY  F 

A (106)  AIRCRAFT  DISTANCE  NORTH  OF  RUNWAY  THRESHOL  F 

A (107)  AIRCRAFT  DISTANCE  EAST  OF  RUNWAY  THRESHOLD  F 

A( 109 )  RADIUS  FROM  EARTH'S  CENTER  TO  AIRCRAFT  F 

A (14 5)  TOTAL  AIRCRAFT  X  FORCE  (FORWARD)  LBS 

A( 146)  TOTAL  AIRCRAFT  Y  FORCE  (RIGHTWARD)  LBS 

A(  147 )  TOTAL  AIRCRAFT  Z  FORCE  (DOWNWARD)  LBS 

A(  148 )  TOTAL  FORCE  NORTH,  L- FRAME  LBS 

A( 149 )  TOTAL  FORCE  EAST,  L- FRAME  LBS 

A(150)  TOTAL  FORCE  DOWN  TOWARD  EARTH  CENTER  LBS 

A( 151 )  FORCE  DUE  TO  GRAVITY  (AT  ALT.)  L-FRAME  LBS 

A( 164)  TOTAL  AIRCRAFT  ROLL  MOMENT  F-LBS 

A(165)  TOTA:.  AIRCRAFT  PITCH  MOMENT  F-LBS 

A(  166 )  TOTAo  AIRCRAFT  YAW  MOMENT  F-LBS 

A(  1 74 )  C.G.  X  POSITION  W/R/T  RUNWAY  FRAME  F 

A(175)  C.G.  .  '’OS  If  I  CM  W/R/T  RUNWAY  FRAME  F 

A(  176)  C.G.  HEIGHT  ABOVE  RUNWAY  F 

A ( 1 7 8 )  DYNAMIC  PRESSURE  LB/F2 

A(179)  IMPACT  PRESSURE  LB/F2 

A( 183)  AIR  DENSITY  AT  ALTITUDE  SLUG/Fi 

A( 209 )  VELOCITY  OF  SOUND  AT  ALTITUDE  F/S 

A(303)  TIME  SINCE  START  OF  OPERATE  MODE  SEC 

A( 332 )  TOTAL  TEMPERA  1\  RE  RATIO  NONE 

A(333)  TOTAL  PRESSURE  RATIO  NONE 

A(364)  SEA  L  VEL  DENSITY  (STANDARD  DAY)  SLUG/FI 

A(366)  AMBIfci"  TEMPERA  PURE  DECK 

A(367)  AMBIEi  PRESSURE  LB/F2 

A(368)  TOTAL  ,  TIPERATURE  DEG  K 

A(  369)  TOTAL  IV  SSI  JR  E  LB/F2 

A(413)  FORWARD  ACCELERATION,  B-FRAME  F/S2 


on  on 


C  VBD  A(414)  RIGHTWARD  ACCELERATION,  B-FRAME  F/S2 

C  WBD  A(415)  DOWNWARD  ACCELERATION,  B-FRAME  F/S2 

C  VTWN  A(416)  TOTAL  WIND  VEL. (NORTH)  INCL.  TURB.  F/S 

C  VTWE  A(417)  TOTAL  WIND  VEL. (EAST)  INCL.  TURB.  F/S 

C  VTWD  A(418)  TOTAL  WIND  VEL. (DOWN)  INCL.  TURB.  F/S 


C  VNTURB  A (419)  RANDOM  COMPONENT  (NORTH)  TURB.  VELOCITY  F/S 

C  VETURB  A(420)  RANDOM  COMPONENT  (EAST)  TURB.  VELOCITY  F/S 

C  VDTURB  A(421)  RANDOM  COMPONENT  (DOWN)  TURB.  VELOCITY  F/S 

C  PAMBR  A(424)  RATIO  OF  AMB.  PRESSURE  TO  SEA  LEV.  PRES.  NONE 

C  TAMBR  A(425)  RATIO  OF  AMB.  TEMP.  TO  SEA  LEV.  TEMP.  NONE 

C 

C  ICOND  IA(141)  CONSTANT  DENSITY  SELECTION  SWITCH 
C 
C 
C 

C********************************************************************** 
C  COMMONS 


COMMON/FARMCOP/ARM ( 400 ) 

COMMON  /IAAHCM/IAAH(50) 

COMMON  /ICNTRL/I COZERO!  ADDED  6/26/87  GLH 
COMMON  /IFIXED/  IA(250) 

COMMON  /IRMCOP/IRM(60) 

COMMON /XFLOAT /A ( 500) 


C********************************************************************** 

C  EQUIVALENCIES 

C********************************************************************** 

c 

EQUIVALENCE  (A(  1),  PHI) 

EQUIVALENCE  (A(  2),  THET) 

EQUIVALENCE  (A(  3),  PSI) 

EQUIVALENCE  (A(  4),  PHIR) 

EQUIVALENCE  (A(  5),  THETR) 

EQUIVALENCE  (A(  6),  PSIR) 

EQUIVALENCE  (A(  7),  PHID) 

EQUIVALENCE  (A(  8),  THED) 

EQUIVALENCE  (A(  9),  PSID) 

EQUIVALENCE  (A(  10),  SPHI) 

EQUIVALENCE  (A(  11),  CPHI) 

EQUIVALENCE  (A(  12),  STHT) 

EQUIVALENCE  (A(  13),  CTHT) 

EQUIVALENCE  (A(  14),  SPSI) 

EQUIVALENCE  (A(  15),  CPSI) 

EQUIVALENCE  (A(  16),  Til) 

EQUIVALENCE  (A(  17),  T21) 

EQUIVALENCE  (A(  18),  T31) 

EQUIVALENCE  (A(  19),  T12) 

EQUIVALENCE  (A(  20),  T22) 

EQUIVALENCE  (A(  21),  T32) 
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EQUIVALENCE 

(A( 

22), 

T13) 

EQUIVALENCE 

(A( 

23), 

T23) 

EQUIVALENCE 

(A( 

24), 

T33) 

EQUIVALENCE 

(A( 

25), 

ALFA) 

EQUIVALENCE 

(A( 

26), 

BETA) 

EQUIVALENCE 

(A( 

27), 

ALFAR) 

EQUIVALENCE 

(A( 

28), 

BETAR) 

EQUIVALENCE 

(A( 

29), 

ALFD) 

EQUIVALENCE 

(A( 

30), 

BETD) 

EQUIVALENCE 

(A( 

31), 

SALPH) 

EQUIVALENCE 

(A( 

32), 

CALPH) 

EQUIVALENCE 

(A( 

33), 

SBETA) 

EQUIVALENCE 

(A( 

34), 

CBETA) 

EQUIVALENCE 

(A( 

35), 

GAMV) 

EQUIVALENCE 

(  A  ( 

36), 

GAMH) 

EQUIVALENCE 

(A( 

37), 

PB) 

EQUIVALENCE 

(A( 

38), 

QB) 

EQUIVALENCE 

(A( 

39), 

RB) 

EQUIVALENCE 

(A( 

40)  , 

PL) 

EQUIVALENCE 

(A( 

41), 

QL) 

EQUIVALENCE 

(A( 

42)  , 

RL) 

EQUIVALENCE 

<A( 

43), 

PLB) 

EQUIVALENCE 

(  A( 

44), 

QLB) 

EQUIVALENCE 

(A( 

45), 

RLB) 

EQUIVALENCE 

(  A( 

46)  , 

PT) 

EQUIVALENCE 

(A( 

47), 

QT) 

EQUIVALENCE 

(A  ( 

48), 

RT) 

EQUIVALENCE 

(  A  ( 

49)  , 

PBWN) 

EQUIVALENCE 

(A( 

50)  , 

QBWN) 

EQUIVALENCE 

(A( 

51), 

RBWN) 

EQUIVALENCE 

(A( 

52), 

PTURB) 

EQUIVALENCE 

(M 

53), 

QTURB) 

EQUIVALENCE 

(AC 

54)  , 

RTURB ) 

EQUIVALENCE 

( A  ( 

55), 

PBD) 

EQUIVALENCE 

(A( 

56), 

QBD) 

EQUIVALENCE 

(A( 

n, 

RBD) 

EQUIVALENCE 

(A( 

58)  , 

UB) 

EQUIVALENCE 

(A( 

5"-)  , 

VB) 

EQUIVALENCE 

(  A  ( 

6 

WB) 

EQUIVALENCE 

(A( 

61,)  , 

UTURB) 

EQUIVALENCE 

( A  ( 

62), 

VTURB) 

EQUIVALENCE 

(A( 

63), 

WTURB) 

EQUIVALENCE 

(A( 

64)  , 

VN) 

EQUIVALENCE 

(A( 

65), 

VE) 

EQUIVALENCE 

(A  ( 

66), 

VD) 

EQUIVALENCE 

(  A  ( 

6  7), 

VEE) 

EQUIVALENCE 

(A( 

63)  , 

VT) 

EQUIVALENCE 

( A  ( 

6')  , 

VG) 

EQUIVALENCE 

(  A  ( 

11 ) 

VRW) 

EQUIVALENCE 

(A( 

7  , 

XMACH) 

EQUIVALENCE 

(A( 

77' 

VNR) 

EQUIVALENCE 

(A  ( 

73)  , 

VER) 

EQUIVALENCE 

(  A  ( 

74)  , 

VDR ) 

EQUIVALENCE 

(  A  ( 

75)  , 

VEQ) 

EQUIVALENCE  (A(  76),  VNW) 
EQUIVALENCE  (A(  77),  VEW) 
EQUIVALENCE  (A(  78),  VDW) 
EQUIVALENCE  (A(  80),  ALTD) 
EQUIVALENCE  (A(  81),  XLOND) 
EQUIVALENCE  (A(  82),  XLATD) 
EQUIVALENCE  (A(  83),  ALT) 
EQUIVALENCE  (A(  84),  XLON) 
EQUIVALENCE  (A(  85) ,  XLAT) 
EQUIVALENCE  (A(  86),  SLAT) 
EQUIVALENCE  (A(  87),  CLAT) 
EQUIVALENCE  (A(  88),  VND) 
EQUIVALENCE  (A(  89),  VED) 
EQUIVALENCE  (A(  90) ,  VDD) 
EQUIVALENCE  (A(  91),  AX) 
EQUIVALENCE  (A(  92),  AY) 
EQUIVALENCE  (A(  93),  AZ) 
EQUIVALENCE  (A(  94),  AXP) 
EQUIVALENCE  (A(  95),  AYP) 
EQUIVALENCE  (A(  96),  AZP) 
EQUIVALENCE  (A(97) ,  G) 
EQUIVALENCE  (A(101),  VCAL) 
EQUIVALENCE  (A(103),  XPR) 
EQUIVALENCE  (A(104),  YPR) 
EQUIVALENCE  (A(105),  HPR) 
EQUIVALENCE  (A(106),  DNR) 
EQUIVALENCE  (A(107),  DER) 
EQUIVALENCE  (A(108) ,  RR) 
EQUIVALENCE  (A(109),  RTV) 
EQUIVALENCE  (A(lll),  XLATR) 
EQUIVALENCE  (A(112),  XLONR) 
EQUIVALENCE  (A(113),  CLATR) 
EQUIVALENCE  (A(114),  STHETR) 
EQUIVALENCE  (A(115) ,  CTHETR) 
EQUIVALENCE  (A(130) ,  XMASS) 
EQUIVALENCE  (A(136) ,  FAX) 
EQUIVALENCE  (A(137) ,  FAY) 
EQUIVALENCE  (A(138),  FAZ) 
EQUIVALENCE  (A(139),  FEX) 
EQUIVALENCE  (A(140),  FEY) 
EQUIVALENCE  (A(141),  FEZ) 
EQUIVALENCE  (A(142),  FGX) 
EQUIVALENCE  (A(143) ,  FGY) 
EQUIVALENCE  (A(144),  FGZ) 
EQUIVALENCE  (A(145),  FTX) 
EQUIVALENCE  (A(146) ,  FTY) 
EQUIVALENCE  (A(147) ,  FTZ) 
EQUIVALENCE  (A(148) ,  FN) 
EQUIVALENCE  (A(149),  FE) 
EQUIVALENCE  (A(150),  FD) 
EQUIVALENCE  (A(151),  FG) 
EQUIVALENCE  (A( 155 ) ,  TAL) 
EQUIVALENCE  (A(156),  TAM) 
EQUIVALENCE  (A(157),  TAN) 
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EQUIVALENCE  (A(158) ,  TEL) 
EQUIVALENCE  (A(159) ,  TEM) 
EQUIVALENCE  (A(160),  TEN) 
EQUIVALENCE  (A(161),  TGL) 
EQUIVALENCE  (A(162),  TGM) 
EQUIVALENCE  (A(163) ,  TGN) 
EQUIVALENCE  (A(164) ,  TTL) 
EQUIVALENCE  (A(165) ,  TTM) 
EQUIVALENCE  (A( 166 ) ,  TTN) 
EQUIVALENCE  (A(168),  DT2  ) 
EQUIVALENCE  (A(170) ,  HR) 
EQUIVALENCE  (A< 171) ,  XP) 
EQUIVALENCE  (A( 172 ) ,  YP) 
EQUIVALENCE  (A(173) ,  ZP) 
EQUIVALENCE  (A(174) ,  XCG) 
EQUIVALENCE  (A(175) ,  YCG) 
EQUIVALENCE  (A(176),  HCG) 
EQUIVALENCE  (A( 177 ) ,  WAIT) 
EQUIVALENCE  (A(178) ,  QBAR) 
EQUIVALENCE  (A(179),  QBARC) 
EQUIVALENCE  (A(183),  RHO) 
EQUIVALENCE  (A(209) ,  SOUND) 
EQUIVALENCE  ( A ( 2 31 ) ,  THETIC) 
EQUIVALENCE  (A(232),  PSIIC) 

EQUIVALENCE  (A(293),  SOUNDZ) 
EQUIVALENCE  (A(303),  TIME) 
EQUIVALENCE  (A(332),  TR) 
EQUIVALENCE  (A(333),  PR) 
EQUIVALENCE  (A(336),  RE) 
EQUIVALENCE  (A( 337 ) ,  REINV) 
EQUIVALENCE  (A(347),  OMEG) 
EQUIVALENCE  (M’S 9),  R2D) 
EQUIVALENCE  (4(358),  D2R) 

EQUIVALENCE  ( A (  3 'CO  ,  HRHOZ) 
EQUIVALENCE  (A(3<',  ),  TAMB) 
EQUIVALENCE  (A(3n7),  PAMB) 
EQUIVALENCE  (A(36H>  TTOT) 
EQUIVALENCE  (A(36‘<  PTOT) 
EQUIVALENCE  (A(370),  DEIAT) 
EQUIVALENCE  (A(375),  XMCC1) 
EQUIVALENCE  (A(376),  XMCC2) 
EQUIVALENCE  (A(377),  XMCC3) 
EQUIVALENCE  (A(378),  XMCC4) 
EQUIVALENCE  (A(379) ,  XMCC5) 
EQUIVALENCE  (A(380;,  XMCC6) 
EQUIVALENCE  ( A ( 3 8 1  ,  ,  XMCC7) 
EQUIVALENCE  (A(4l'»  ,  UBD) 
EQUIVALENCE  (A(4L'  ,  VBD) 

EQUIVALENCE  (A(415.  WBD) 
EQUIVALENCE  (A(416)  VTWN) 
EQUIVALENCE  (A(41>'.  7TWE) 
EQUIVALENCE  (A(418) ,  VTWD) 
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EQUIVALENCE 

(A(419), 

VNTURB ) 

EQUIVALENCE 

(A(420) , 

VETURB) 

EQUIVALENCE 

(A(421) , 

VDTURB ) 

EQUIVALENCE 

(A(424) , 

PAMBR) 

EQUIVALENCE 

(A(425) , 

TAMBR) 

EQUIVALENCE 

(A(426)  , 

TLAT) 

EQUIVALENCE 

(IA(  1), 

IMODE) 

EQUIVALENCE 

(IA(  6), 

I FLAT) 

EQUIVALENCE 

(IA(  7), 

IFFCI ) 

EQUIVALENCE 

(IA(  29), 

I  AND) 

EQUIVALENCE 

(IA(  33), 

ILWD) 

EQUIVALENCE 

(IA(141) , 

ICOND) 

EQUIVALENCE 

(IA(185) , 

IETURB) 

EQUIVALENCE 

(IA(187) , 

ITOMTR) 

EQUIVALENCE 

( IA( 200) , 

IFREEZ) 

EQUIVALENCE 

( ZLVT 

,  XHO 

(  D) 

EQUIVALENCE 

(ZMUT 

,XHO 

(  2)) 

EQUIVALENCE 

( ZMWT 

,XHO 

(  3)) 

EQUIVALENCE 

(ZNVT 

,  XI’C 

(  4)) 

EQUIVALENCE 

(ZUT 

,  XHO 

(  5)) 

EQUIVALENCE 

( ZWTT 

,  XHO 

(  6)) 

EQUIVALENCE 

(ZLPT 

,  XHO 

(  7)) 

EQUIVALENCE 

(XLPHIO 

,  XHO 

(  8)) 

EQUIVALENCE 

(XLDAT 

,  XHO 

(  9)) 

EQUIVALENCE 

(ZMQT 

,  XHO 

(  10)) 

EQUIVALENCE 

(XMTHETO 

,XUO 

(  ID) 

EQUIVALENCE 

(XMDET 

,  XHO 

(  12)) 

EQUIVALENCE 

( ZNRT 

,  XHO 

(  13)) 

EQUIVALENCE 

(XNDPT 

,  XHO 

(  14)) 

EQUIVALENCE 

( ZWT 

,  XHO 

(  15)) 

EQUIVALENCE 

(  ZDCT 

,  XHO 

(  16)) 

EQUIVALENCE 

(XUT 

,  XHO 

(  17)) 

EQUIVALENCE 

(YVT 

,  XHO 

(  18)) 

EQUIVALENCE 

(  ZMU 

,  XHO 

(  19)) 

EQUIVALENCE 

( ZLV 

,  XHO 

(  20)) 

EQUIVALENCE 

(FPS2KOS 

,  XHO 

(  23)) 

EQUIVALENCE 

(XNVO 

,  XHO 

(  24)) 

EQUIVALENCE 

(  ZNPO 

,  XHO 

(  25)) 

EQUIVALENCE 

(XNPHIO 

,  XHO 

(  26)) 

EQUIVALENCE 

(XNV 

,  XHO 

(  27)) 

EQUIVALENCE 

(ZUO 

,  XHO 

(  28)) 

EQUIVALENCE 

(ROLLOP 

,  XHO 

(  90)) 

EQUIVALENCE 

(PITCHOP 

,  XHO 

(  91)) 

EQUIVALENCE 

(YAWOP 

,  XHO 

(  92)) 

EQUIVALENCE 

(COLOP 

,  XHO 

(  93)) 

EQUIVALENCE 

(  ARM 

(  4)  , 

COLTRM 

EQUIVALENCE 

(  ARM 

(  5)  , 

FRX 

EQUIVALENCE 

(  ARM 

(  6)  , 

FRY 

EQUIVALENCE 

(  ARM 

(  7)  , 

FRZ 
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c 


c 


EQUIVALENCE 

( 

ARM 

(  8) 

» 

PBDR 

) 

EQUIVALENCE 

( 

ARM 

(  9) 

t 

QBDR 

) 

EQUIVALENCE 

( 

ARM 

(  10) 

f 

RBDR 

) 

EQUIVALENCE 

( 

ARM 

(  23) 

* 

SGVOL 

) 

EQUIVALENCE 

( 

ARM 

(  24) 

> 

SGVOLIC 

) 

EQUIVALENCE 

( 

ARM 

(  25) 

• 

SGVOLOP 

) 

EQUIVALENCE 

( 

ARM 

(  26) 

1 

TINC 

) 

EQUIVALENCE 

( 

ARM 

(  31) 

1 

TINCIC 

) 

EQUIVALENCE 

( 

ARM 

(  32) 

l 

TINCOP 

) 

EQUIVALENCE 

( 

AR1 

(  33) 

» 

ROLGRD 

) 

EQUIVALENCE 

( 

ARM 

(  34) 

> 

ROLBRK 

) 

EQUIVALENCE 

( 

AIM 

(  35) 

» 

ROLHYS 

) 

EQUIVALENCE 

( 

ARM 

(  36) 

1 

PCHGRD 

) 

EQUIVALENCE 

( 

ARM 

(  37) 

» 

PCHBRK 

) 

EQUIVALENCE 

( 

ARM 

(  38) 

i 

COLHYS 

) 

EQUIVALENCE 

( 

ARM 

(  39) 

• 

PEDGRD 

) 

EQUIVALENCE 

( 

ARM 

(  40) 

» 

PEDBRK 

) 

EQUIVALENCE 

( 

ARM 

(  41) 

1 

PEDHYS 

) 

EQUIVALENCE 

( 

ARM 

(  42) 

l 

CLCFRC 

) 

EQUIVALENCE 

( 

ARM 

(  43) 

» 

CLCBRK 

) 

EQUIVALENCE 

( 

ARM 

(  51) 

t 

TRIMlC 

) 

EQUIVALENCE 

( 

ARM 

(  52) 

l 

TRIM2C 

) 

EQUIVALENCE 

( 

ARM 

(  53) 

1 

TRIM3C 

) 

EQUIVALENCE 

( 

ARM 

(  54) 

i 

CLCGRD 

) 

EQUIVALENCE 

( 

ARM 

(108) 

i 

ANZ 

) 

EQUIVALENCE 

( 

ARM 

(110) 

f 

BETAHUD 

) 

EQUIVALENCE 

( 

ARM 

(113) 

» 

PHIRDM 

) 

EQUIVALENCE 

( 

ARM 

(209) 

f 

QRAPCT 

) 

EQUIVALENCE 

( 

ARM 

(363) 

• 

FIMB 

) 

EQUIVALENCE 

(ICON 

,  IAAH 

(15) .ICONFI) 

EQUIVALENCE 

(ICS 

,  IAAH 

(20) 

) 

EQUIVALENCE 

'y 
\  * 

ICS 

,  IAAH 

(21) 

) 

EQUIVALENCE 

( MCON 

.IAAH 

(22) 

) 

EQUIVALENCE 

( 

IRM 

(  48) 

r 

LI  MG 

) 

EQUIVALENCE 

( 

IR'l 

(  49) 

t 

LIMRPM 

) 

EQUIVALENCE 

( 

IRM 

(  50) 

, 

LIMBET 

) 

EQUIVALENCE 

( 

IRM 

(  51) 

> 

BETA FG 

) 
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HAC2.INC 


C**************** ************************************************ 

C  HAC2 . INC 

C*************************************************************** 

COMMON /HACDAT /ROLLO  ,  PITCHO ,  YAWO ,  ROLMAX ,  PITMAX  ,  YAWMAX  ,  COLUMN  , 
&  COLOMAX , RDBO , PDBO , YDBO , CDBO , OOOG1 , OOOG2 , OOOG3 , 

&  OOOG4 , 000B4 , IMBC , ILITE , GNUD , GRLD , TRIMl , TRIM1P , TRIM2 , 

&  TRIM2P , TR1M3 , TRIM3P , TRIM4 , TRIM4C , TRIM4P , COLMINT , 

&  COLMAXT , PCTBIAS , CBAUTO , CGAUTO , CFMAN , CFAUTO , 

&  XRT , YRT , ZRT , XKDP , XLPHI 1 , XLPHI2 , XLPHI 3 , 

&  ZLPD , ZMQD , ZMQl , ZMQ2 , ZLP1 , ZLP2 , XLDAl , XLDA3 , XMDE1 , 

&  XMDE3 , SLP1 , YINT1 , SLP2 , YINT2 , SLP3 , YINT3 , SLP4 , YINT4 , 

&  SLP5 , YINT5 , RODSLP , ROD INTI , RODINT2 , THETV1C , 

&  THETOFF , TAUCOL , GCOL , APPPCT , REDTIME , LTRIM , 

&  COLOZ , COLF1 , COLF2 , ROCLIM , COLO , EROM4 , 

&  HLEV , XM1 , PRESZ , TEMPZ , YCON , TEMA , DELT , DELTH , DELTI , 

&  ESLP1 ( 3 ) , ESLP2 (3) , El NT 1(3) , EINT2 (3) ,VEQPT(3) , 

&  RSLP1 ( 3 ) , RSLP2 ( 3 ) ,XINT1(3) ,XINT2(3) , 

&  VQMAX ( 6 ) , RTMAX ( 6 ) ,VQMIN(6) ,RTMIN(6) , 

&  XMC(IO) , YMINT ( 6 ) ,RYINT(6) , SLPMN(6) , SLPMX(6) , 

&  AAP(2) ,BBP(3) , BUFFP( 7 ) , XXP ( 2 ) , AAR ( 2 ) , BBR ( 3 ) , 

&  BUFFR( 7 ) , XXR ( 2 ) 
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HAC3.INC 


C*************************************************************** 

C  HAC3.INC 

C*************************************************************** 

LOGICAL*^  alt_hold  ! Freeze  altitude.  MCL  01/22/88 
LOGICAL*4  airspeed_hold  ! Freeze  airspeed.  MCL  01/25/88 

INTEGER*4  chad(6)  IContains  the  a/d  inputs. 

L0GICAL*4  clready  (True  when  collective  is  trimmed 
REAL*4  clstk  ! Delta  on  collective  when  mode  is  4 
REAL*4  coloffset 

REAL*4  colscalar 

REAL*4  coloptol  IPrimary  control  stick  setting  for  ! collective 

L0GICAL*4  heading_hold  ! Freeze  heading.  MCL  01/25/88 

REAL*4  pitchoptol  IPrimary  control  stick  setting  for  Ipitch 

REAL*4  rolloptol  IPrimary  control  stick  setting  for  roll 

L0GICAL*4  gocom  I  Set  to  true  by  the  pilot  to  start  ! flying 

L0GICAL*4  lclose7  ITrue  when  file  7  (Vectrix)  was  closed 

INTEGER*4  lpamode  I  Used  on  main. for 

INTEGER*4  mode  I  Mode  of  fly 

REAL*4  pedoffset 

REAL*4  pedscalar 

REAL*4  pitoffset 

REAL*4  pitscalar 

REAL*4  pstk  I  Delta  on  pitch  when  mode  is  4 

L0GICAL*4  ptready  ITrue  when  pitch  is  trimmed 

L0GICAL*4  rdready  ITrue  when  pedals  are  trimmed 

REAL*4  rdstk  .'Delta  on  pedals  when  mode  is  4 

LOG I CAL* 4  rlready  ITrue  when  roll  is  trimmed 

REAL*4  rlstk  I  Delta  on  roll  when  mode  is  4 
REAL*4  roloffset 

REAL*4  rolscalar 

REAL*4  yawoptol  IPrimary  control  stick  setting  for  I  pedals 

INTEGER*4  iallmulax  IWhen  set  to  1  will  provide  collective  land  yaw  on 

multiaxis  controller. 

COMMON/HACTRIM/ 

&  chad ,lclose7,cl'eidy1clstk, coloffset, colscalar, 

&  coloptol .yawoptol , pi tchoptol ,  alt_hold,  airspeed_hold , 

&  heading_hold ,  rol 1 optol , gocom , lpamode . mode , pedoffset , 

&  pedscalar, pi toffs  =  .pitscalar , pstk .ptready , rdready , 

&  rdstk , rlready , r 1st  k , roloffset , rolscalar , ial Imulax 
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MOVGBL. INC 


C*************************************************************** 

c  MOVGBL. INC 

C*************************************************************** 
INTEGER**  MOX(IO) 

INTEGER*4  MOY(IO) 

INTEGER*4  MOZ(IO) 

I NT EGER* 2  ATYPE(IO) 

I NT EGER* 2  ACAT(IO) 

INTEGER*2  AGROUP(IO) 

REAL*4  MOU(IO) 

REAL*4  MOHEAD(IO) 

REAL*4  MOPHI(IO) 

REAL*4  MOTHET(IO) 

COMMON /MOVOBJ  GBL/MOX , MOY , MOZ , ATYPE , ACAT , AGROUP , 

&  MOU , MOHEAD , MOPHI , MOTHET 
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FLTDATA . INC 


C*************************************************************** 


C  FLTDATA. INC 

C*************************************************************** 


LOG I CAL* 1 
LOG I CAL* 1 
LOG I CAL* 1 
LOG I CAL* 1 
LOGICAL*! 
LOG I CAL* 1 
LOG I CAL* 1 
LOGICAL*! 


CHARACTER*4 
LOG I CAL* 1 
INTEGER*2 
BYTE 

INTEGER*4 

INTEGER*4 

REAL 


INIT_DATA_COL , CRASH_DET 

BEGIN_FLT 

START_TALK 

DYNAMIC 

VOICE_BEGIN 

WAYPT_BEGIN ( 8 ) , WAYPT_S ENT ( 8 ) 

END_FLIGHT 

WAYPT_READY  !mcl  04-01-1986  Tells  when 
(waypoint  is  ready  to  be 
(entered. 

key_input 

BEGIN_ENTER(8) 

WAYPT_NUM 

WAYPT(IO) 

WAYPT_ERR , FSX2 , FSY2 

TEST_MODE 

TURN  RATE 


COMMON/YFLTDAT/WAYPT_NUM , WAYPT , WAYPT_SENT , WAYPT_BEGIN , 
&  INIT_DATA_COL , BEGIN_FLT , CRASH_DET , START_TALK , 

&  TEST_MODE , DYNAMIC ,VOICE_BEGIN , FSX2 , FSY2 , key_input , 

&  TURN_RATE , WAYPT_READY , BEGIN_ENTER , END_FLIGHT , 

&  WAYPT  ERR 
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APPENDIX  B 

MAIN  PROGRAMS  SOURCE  CODE 
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START  HACSEC . FOR 


C**************************************  *************************** 

Program  START_HACSEC  !7  december  1987  mcl 

C  Author:  Maria  del  C.  Lopez 
C 

C  This  program  creates  the  global  section  to  be  used  by  the  hac  equations 
c  on  CANCER . 
c 

c  Directory: 

c  CANCER: : [helhac . for] 

c 

c  Subroutines  called: 
c  Get_chan 

c 

c  Files  opened: 

c  Hacsec.dat . . - . 'unknown' 

c 

c  Global  section  name: 
c  HACSEC 

c 

c  Common  section  name: 
c  ACHANNEL 

c  *********************************************************************** 

INCLUDE  ' [HELHAC. FOR ] HAC 1. INC/LIST' 

INCLUDE  ' [ HELHAC . FOR] HAC2 . INC/LIST ' 

INCLUDE  ' [HELHAC. FOR] HAC 3. INC/LIST' 

INCLUDE  ' [HELHAC. FOR [HELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR 1FLTDATA. INC/LI ST' 

INCLUDE  ' ($SECDEF) ' 

INCLUDE  ' ($SSDEF) ' 

INCLUDE  ' ( $IODEF) ' 

INTEGER**  S YS $ CRM PS C, STATUS 

INTEGER**  SEC_FLAGS . MAPRANGE(2) , RETADR(2) 

INTEGERS  GET_CHAN 
INTEGER*2  SEC_CHAN 

REAL*4  FI 

CHARACTERS  HAC1  SEC/ '  HACSEC '  / 

EXTERNAL  GET_CHAN 

COMMON  /ACHANNEL/ S EC_CHAN 
c . . .cluster 
INTEGER**  sys$ascefc 

INTEGER**  sys$waitfr . sys$clref , sys$setef 
CHARACTER*8  clnaneJ  / ' CLUSTER3 ' / 

c  Associate  cluster  3 
status  -  sys$ascefc(Xval(96) ,clname3 , , ) 
if  (.not.  status)  call  lib$stop(Xval (status) ) 
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C  Create  section  to  share  data  with  DR11  and  A/D30Hz  pt". 

MAPRANGE(l)  -  XLOC(ARM(l)) 

MAPRANGE(2)  -  XLOC (WAYPT_ERR) 

SEC_FLAGS  -  SEC$M_GBL  .OR.  SEC$M_WRT  .OR.  SEC$M_DZRO 

OPEN (UNIT-1 , FILE=' HACSEC . DAT' ,USEROPEN=GET_CHAN , SHARED , 
&  INITIALSIZE-60, STATUS-' UNKNOWN ' ) 

STATUS  -  SYS$CRMPSC(MAPRANGE,RETADR, , %VAL( SEC_FLAGS ) , 

&  HAC1SEC , , ,%VAL(SEC_CHAN) ,ZVAL(60) , , ,) 

IF  (.NOT.  STATUS)  CALL  LI B$STOP(ZVAL( STATUS ) ) 


STATUS  -  SYS$SUSPND( , ) 

IF  (.NOT.  STATUS)  CALL  LI B$STOP(ZVAL( STATUS ) ) 


o  o  o 


AD30HZ . FOR 


PROGRAM  AD30HZ 

C  A/D  values  from  the  ADV11  A/D  using  memory  mapped  I/O 
C 

C  This  example  shows  the  synchronous  user  interface  (LIO$READ) 

C  and  memory  mapped  I/O 
C 

C  First,  the  program  sets  up  the  ADV  as  follows: 

C  use  A/D  channels  0  THRU  15 

C  use  a  gain  of  one 

C  start  immediately  on  the  LIO$READ  call  and  keep  cycling  through  the 

C  selected  channels  as  fast  as  the  A/D  can  go  until  the  buffer  is  full 

C 

C  Second,  the  program  reads  the  data  into  the  buffer. 

C 

C 

C  Compile,  link,  and  run  the  program  as  follows: 

FORTRAN  example4_l 
LINK  example4_l 
RUN  examp le4_l 

INCLUDE  ' sys$library : LIOSET . FOR'  !LIO$SET_I  symbol  definitions 

INCLUDE  ' [HELHAC. FOR] HAC1. INC/LI ST' 

INCLUDE  ' [HELHAC. FOR]HAC2. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] HAC3. INC/LIST' 

INCLUDE  ' [HELHAC. FOR ]HELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] FLTDATA. INC/LIST' 


INCLUDE  ' ( $SECDEF) ' 
INCLUDE  ' ($SSDEF) ' 


INTEGER*2 

INTEGER 

INTEGER 

INTEGER 

INTEGER 


buffer(17) 

device_ID 

data_length 

status 

COUNTER 


!  twenty  word  bui.  for 
Idevice  ID  variable 
! amount  of  dat.  read  (in 
!f  ,’tes) 

!  status  returned  by  LIO 
' call s 


INTEGERS 

INTEGER*4 

INTEGERS 

INTEGERS 


SYS$SETIMR , SYS$CLREF , SYS$WAITFR 
SYS$MGBLSC , SYS$SETEF, SYS$BINTIM 
B I NARY_ I NT ERVAL ( 2 ) 

SEC_FLAGS ,MAPRANGE(2 ) , RETADR( 2) 


CHARACTER  ASCI I_INTERVAL*10  /'0  0:0:0.03'/ 
CHARACTER*8  CLUSTER_NAME/ ' CLUSTER3 ' / 
CHARACTER*6  HACISEC/'HACSEC'/ 
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o  o 


COMMON  /ADCOM/BUFFER 


COUNTER  -  0 

STATUS-  SYS$BINTIM(ASCII_INTERVAL, BINARY_INTERVAL) 

IF( . NOT .  STATUS)  CALL  LIB$SIGNAL(%VAL(STATUS) ) 

STATUS  -  SYS$ASCEFC(%VAL(96) , CLUSTER_NAME , , ) 

IF( .NOT,  STATUS)  CALL  LIB$SIGNAL(ZVAL(STATUS) ) 

MAPRANGE(l)  -  %LOC(ARM(l)) 

MAPRANGE(2)  -  %LOC(WAYPT_ERR) 

SEC_FLAGS  -  SEC$M_WRT 

STATUS  =  SYS$MGBLSC(MAPRANGE,RETADR, , %VAL( SEC_FLAGS ) , 
&  HAC1SEC , , ) 

IF( . NOT .  STATUS)  CALL  LIB$SIGNAL(%VAL(STATUS) ) 


C  Attach  to  the  A/D 

C  Gets  a  device_ID  for  the  ADV  and  tells  LIO  to  use  memory 

C  mapped  I/O 

C 

status  =  LIO$ATTACH(device_ID ,  'AZAO',  LIO$K_MAP)  lattach 

! to  axv 

1 F ( . NOT . (status) )  CALL  lib$signal(%val(status) ) 

C  Set  up  the  A/D 

synchronous  I/O  (LIO$READ/LIO$WRITE) 

A/D  channels  zero  to  FIFTEEN 
C  A/D  gain  of  1  for  all  five  channels 

C  Trigger  mode  -*■  start  on  LIO$READ  and  fill  buffer  as  fast 

C  .is  possible 

C 

status  -  LIO$SI.i'_l  (device_ID,  LIO$K_SYNCH ,  0) 

IF( . NOT. (status) )  CALL  lib$signal(%val(status) ) 
status  =  LI 0$ SET  - ( dev i co_I D ,  LIO$K_AD_CHAN ,  16. 

&  0, 1,2,3, ‘*.5,6,7, 8,9, 10,11, 12,13, 14. 15) 

I F( . NOT . (status) )  CALL  1 ib$s ignal (%va 1 ( status ) ) 
status  -  LIO$SET_I(device_lD,  LIO$K_AD_GAIN ,  16, 

&  1,1, 1,1, 1,1,1, 1,1,1, 1,1,1, 1,1,1) 

IF( .NOT. (status) )  CALL  lib$signal(%val (status) ) 
status  -  LI0$SET_I (device_ID ,  LIO$K_TRIG,  1, 

&  LIO$K_ 1MM_BURST) 

I F( .NOT. (status)  ,  CALL  1 i b$. signal (%val (status) ) 

C  SET  THE  INTERVAL  BETWF 1 N  A/D  CONVERSIONS 

100  STATUS-SYS$S':!'IMR(%VAL(1)  ,BINARY_INTERVAL  ,) 

I  F(  .  NOT  .  STATUS)  CALL  Li  .>CS IGNAL(%VAL( STATUS )  ) 

C  read  16  A/D  values  (32  bytes)  into  the  buffer 
C  The  number  of  bytes  transferred  is  returned  in 
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nnooci  n  n  n  n 


data_length 

The  device  specific  parameter  is  not  used  so  it  is 
defaulted 


status  -  LIO$READ(device_ID ,  buffer,  34,  data_length,  ) 
IF( .NOT. (status))  CALL  lib$signal(Xval(status) ) 


CHAD ( 1 )  -  BUFFER (10) 
CHAD(2)  -  BUFFER(ll) 
CHAD ( 3 )  -  BUFFER(2) 
CHAD(4)  -  BUFFER(3) 
CHAD(5)  -  BUFFER(4) 
CHAD(6)  -  BUFFER(7) 
COUNTER  -  COUNTER  +  1 


!  MULTIAXIS  PITCH 
!  MULTIAXIS  ROLL 
!  CONVENTIONAL  COLLECTIVE 
!  CONVENTIONAL  YAW 
!  MULTIAXIS  COLLECTIVE 
!  MULTI AXIS  YAW 


STATUS  -  SYS$SETEF(XVAL(96) ) 

I F ( . NOT .  STATUS)  CALL  LIB$SIGNAL(%VAL(STATUS) ) 

I F( COUNTER  .EQ.  2) THEN 

STATUS  -  SYS$SETEF(%VAL(97) ) 

IF( . NOT .  STATUS)  CALL  LIB$SIGNAL(%VAL(STATUS) ) 
COUNTER  -  0 
ENDIF 


WAIT  FOR  THE  TIMER  TO  TIME  OUT  AS  SIGNALED  BY  EVENT  FLAG  1. 
STATUS-SYS$WAITFR(%VAL(1) ) 

IF( . NOT .  STATUS)  CALL  LIB$SIGNAL(XVAL(STATUS) ) 

GET  DATE  AND  TIME  FOR  EACH  CONVERSION 
STATUS-  LIB$DATE_TIME(  CUR_TIME) 

IF  (.NOT.  STATUS)  CALL  LIB$STOP(%VAL(STATUS) ) 

CLEAR  EVENT  FLAG  1  AND  PREPARE  TO  READ  A/D  AGAIN. 
STATUS=SYS$CLREF(%VAL( 1) ) 

IF( .NOT.  STATUS)  CALL  LIB$SIGNAL(%VAL(STATUS) ) 

CHECK  RATE  OF  CONVERSION 

WRITE(10,99)CUR_TIME 
C99  FORMAT (A23) 


C  WRITE  DATA  TO  DISK  FILE.  NOTE!!  CANNOT  SUSTAIN  30HZ  RATE 
C  WHEN  WRITING  TO  DISK. 

C  WRITE ( 10, 1010) (buffer(i) ,i-l,16) 

C  1010  FORMAT ( 16 ( 2x , 16 ) ) 

GOTO  100 


C  detach  the  device 

C  Rundown  is  not  relevent  for  synchronous  I/O,  so  it  is 
C  defaulted 
C 

status  -  LIO$DETACH(device_ID ,  ) 

IF( . NOT . (status) )  CALL  lib$signal (%val (status) ) 
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STOP  'Done' 
END 


DR11  SND  RCV.FOR 


C*************************************************************** 

C 

c  PROGRAM  DR11_SND_RCV . FOR 

c 

c  The  following  privilges  are  required  to  run  the  drll  software: 
c 

c  $  SET  PR0C/PR1V-PHY_I0 

c  $  SET  PROC/PRIV-LOG_IO 

c 

c  The  following  macro  programs  must  have  been  compiled: 
c 

c  $  MAC  XAMESSAGE+SYS$LIBRARY : LIB . MLB/LIB 

c  $  MAC  XALINK 

c 

c  The  fortran  program  must  also  be  compiled: 
c 

c  $  FOR  DRll_snd_rcv 

c 

c  The  following  link  command  must  be  used: 
c 

c  $  LINK  DRll_snd_rcv+XAMESSAGE+XALINK , LINKER/OPT 

c 

c  The  program  is  now  ready  to  run: 
c 

c  $  RUN  DRll_snd_rcv 

c 

C*************************************************************** 

PROGRAM  DR11_SND_RCV 


C//  implicit  none 

include  ’($secdef)' 
include  '($ssdef)' 

INCLUDE  ' [HELHAC . FORJHACl . INC/LIST' 

INCLUDE  ' [ HELHAC. FOR ]HAC2. INC/LIST' 

INCLUDE  ' [HELHAC. FOR ]HAC3. INC/LIST' 

INCLUDE  ' (HELHAC. FORJHELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] FLTDATA. INC/LIST’ 

INCLUDE  ' SYS $ SHARE :MOVGBL. INC/LIST'  IT.A.B.  A/7/88 

CHARACTER  CLUSTER_NAME*8  / ' CLUSTER3 '/  !  event  flag  cluster 

CHARACTER*6  HAC1SEC  /'HACSEC'/ 

INTEGERS  SYS$MGBLSC ,  S\ :'.$ASCEFC ,  SYS$WAITFR,  SYS$CLREF 
INTEGER*^  SEC  FLAGS,  MAPRANGE(2) ,  RETADR( 2 ) 
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integer*4  indx,  status,  value,  xmit_operation 
integer*4  input_buf fer (400) ,  output_buffer (400) 
integer*4  buffer_size,  local,  remote 
integer*4  i_mox( 10) , i_moy(10) , i_moz(10) 

real*4  r_mou( 10) , r_mophi ( 10) , r_mohead( 10) , r_mothet ( 10) 

logical  test,  master 

character*4  c_key_input 

c.  .  This  common  contains  the  data  to  be  sent  to  the  VAX  11/780 

common  /zzlsnddata/ 

&  rair speed,  r_torque,  rrclimb, 

&  r_altitude,  r_roll,  r_pitch, 

&  r_yaw,  rslip,  rcosphi, 

&  r_slnphi,  r_ugnd,  r_vgnd, 

&  r_der,  r_dnr ,  r_ve ,  r_vn, 

{%  r  phi,  r_thet ,  r_psi,  r_turn_rate, 

A  i  mox,  i_inoy,  i_moz ,  r_mou , 

A  r  mohead,  rmophi ,  rmothet  ! 360  bytes 

c  . .  This  common  contains  the  data  to  be  received  from  the  VAX 
C  11/780 

common  /zzl_rcv_data/ 

&  i_hel_world_x,  i_hel_world_y , 

&  c_key_input  ! 12  bytes 

c...  This  equivalence  associates  the  output  buffer  with  the 
C  snd_data  common. 

equivalence  (output_buffer(l) ,  r_airspeed) 

c...  This  equivalence  associates  the  output  buffer  with  the 
C  rcv_data  common. 

equivalence  ( input_buf fer ( 1 ) ,  i_hel_world_x) 
c. . .  begin  executable  code 

C*********-**-******************-*'***-********'***************  Ar**-**** 
c...  Initialize  variables 
test  -  .TRUE. 

master  -  .TRUE.  !  MicroVAX  will  be  designated  the  master 
buffer_size  -  200  !  buffer  size  in  words 

local  -  2  !  device  type  at  local  end:  1-drll-w,  2-=drvl  1  w 

remote  -  1  !  device  type  at  remote  end 

c...  Associate  the  event  flag  cluster 


status  -  sys$ascefc(Xval(96) ,  cluster_name , , ) 
if  (.NOT.  status)  call  lib$stop(Xval(status) ) 

c...  Set  map  range  for  global  section 

maprange(l)  -  %loc(arm(l)) 
maprange(2)  -  %loc(waypt_err) 

c . . .  set  up  flag  word 

sec_flags  -  sec$m_wrt 

c...  Map  to  global  section 

status  -  sys$mgblsc  (maprange,  retadr,,  %val(sec_flags) , 

&  HAC1SEC , , ) 

if  (.NOT.  status)  call  lib$stop(Zval(status) ) 

do  v/hile  (test) 

c...  Wait  for  the  event  flag  (97). 

status  ■=  sys$waitfr  (Zval(97)) 

if  (.lNOT.  status)  call  lib$stop  (%val(status) ) 

status  -  sys$clref (Xval (97) ) 

if  (.NOT.  status)  call  lib$stop  (Xval(status) ) 
c . . .  Update  the  common  area 

CALL  UPDATE_TO_VAX 

c...  Tranfer  direction  control:  1  for  receive;  0  for  transmit 
c...  'Transmitting  data' 

xmitoperation  -  0  !  set  up  to  transmit  data 

call  DR11_SEND_RECEIVE  ( 

& 

& 

& 

& 

& 

& 

& 

c...  'Receiving  data' 
c...  Update  the  common  area 

CALL  UPDATE_  FROM_VAX 

xmit_operation  -  1  !  set  up  to  receive  data 

call  DRll_SEND_RECEIVE  ( 

&  xmit_operation , 

&  input_buf fer , 


xmit_operation , 
out  >ut_buf fer , 
buf fer_size , 
local , 
remote , 
master 

) 
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buf fer_size , 
local , 
remote , 
master 

) 

end  do 

stop 

end 


6. 

& 

& 

& 

& 


A  2 


HACMAIN  BH.FOR 


C**************************************************************** 

Program  HACMAIN^BH  !7  december  1987  mcl 

C  Author:  NASA  Ames  equations. 

G 

C  This  program  runs  flight  dynamic  equations, 
c 

c  Subroutines  called: 
c  Get_chan 

c  Hacdata 

c  Scale_ad 

c  Smart 

c  Contrl 

c  Fam 

c  Beeper 

c  Vbturb 

c  Wbturb 

c  Ubturb 

c  sys$creprc,  sys$crmpsc,  status 

c  sys$ascefc,  sys$waitfr,  sys$clref 

c 

c  Files  opened: 

c  Hacsec.dat . 'unknown' 

c  [helhac.forjScalars.dat . 'old' 

c 

c  Files  included: 
c  [helhac . for ]hacl . inc 

c  [helhac . for ]hac2 . inc 

c  [helhac . for ]hac3 . inc 

c  [helhac . for [helgbl . inc 

c  [helhac . for ] fltdata . inc 

c 

c  $secdef 

c  $ssdef 

c  $iodef 

c 

c  Global  section  name: 
c  HACSEC 

c 

c  Common  section  name: 
c  ACHANNEL 


c  Cluster  name: 

c  CLUSTER3 _ Flag  96-127 

C  ********************************  A*************-***-*******-******* 

INCLUDE  ' [HELHAC. FOR] HAC1 . INC/LIST' 

INCLUDE  ' [HELHAC. FOR] HAC2 . INC/LIST' 

INCLUDE  ' [HELHAC. F0RJHAC3. INC/LIST' 

INCLUDE  ' (HELHAC. FOR] HELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] FLTDATA. INC/LIST’ 

INCLUDE  ' ( $SECDEF) ' 

INCLUDE  ’ ( $SSDEF) ' 
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INCLUDE  ' ($IODEF) ' 


INTEGERS  SYS$CREPRC ,  SYS$CRMPSC ,  STATUS 
INTEGER*4  SEC_FLAGS ,MAPRANGE(2) , RETADR ( 2 ) 

INTEGER*4  GET_CHAN 
INTEGER*2  SEC_CHAN 

CHARACTER*6  HACISEC/'HACSEC'/ 

EXTERNAL  GET_CHAN 

COMMON  /ACHANNEL/SEC_CHAN 
c . . . cluster 
INTEGER*4  sys$ascefc 
INTEGER*4  sys$waitfr , sys$clref 
CHARACTER* 8  clname3  /'CLUSTER3'/ 

c  Associate  cluster  3 
status  -  sys$ascefc(%val (96 ) , clname3 , , ) 
if  (.not.  status)  call  lib$stop(%val(status) ) 

C  Create  section  to  share  data  with  DR11  and  A/D30Hz  processes 

MAPRANGE(l)  -  %L0C(ARM(1)) 

MAPRANGE(2)  -  XLOC(WAYPT_ERR) 

SEC_FLAGS  -  SEC$M_GBL  .OR.  SEC$M_WRT  .OR.  SEC$M_DZRO 

OPEN (UNIT-1 , FILE-' HACSEC . DAT ' , USEROPEN»GET_CHAN , SHARED , 

&  INITIALSIZE-60 , STATUS- 'UNKNOWN' ) 

STATUS  -  SYS$CRMPSC (MAPRANGE, RETADR, ,XVAL(SEC_FLAGS) , 

&  HAC1SEC , , , %VAL( SEC_CHAN) , XVAL(60) , , ,) 

IF  (.NOT.  STATUS)  CALL  LIB$STOP(ZVAL( STATUS ) ) 

CALL  HACDATA 

C  Read  A/D  scaling  factors 


IF(IALLMULAX  .EQ.  1)THEN 

OPEN (UNIT =4, NAME-' [ HELHAC . FOR ] SCALARS_1 . DAT ' , STATUS- ' OLD ' ) 
READ (4 ,13) PITSCALAR , ROLSCALAR , PEDSCALAR , COLSCALAR , 

&  PITOr FSET , ROLOFFSET , PEDOFFSET , COLOFFSET 

13  FORMAT (8E13 . 3) 

CLOSE  (4) 

ELSE 

OPEN(UNIT-4 , NAME-' [ HELHAC . FOR ] SCALARS . DAT ' , STATUS- ' OLD ' ) 

READ (4 , 13) PITSCALAR , ROLSCALAR , PEDSCALAR , COLSCALAR , 

&  PITOFFSET , ROLOFFSET , PEDOFFSET , COLOFFSET 

CLOSE  (4) 

ENDIF 
IMODE  -  -1 
CONTINUE 


ill,  iliOlit 


•  6L  ■ 


o  )  icozero=u 


c  Fly 

11  CONTINUE 

'  the  flag  from  a/d  process 

it  aucus)  CALL  i ib$s Cop (XVAL(status; ; 

C . . . Clear  the  flag 
status  -  sys$clref (%val(96) ) 

IF  (.NOT.  status)  CALL  lib$stop(XVAL(status) ) 

c  .  .  .  uxOiis 

call  scalead 
call  smart 
call  contrl 
call  fam 
call  beeper 

’’  vV-turb 

w  call  ubturb 

if  (abs(FTZ)  .GT.  wait)  imode  =  1 

FLIOHTTIME  -  NINT< (SECNDS (0 . 0) )*1000 . ) 

GOTO  11 

end 
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APPENDIX  C 

SUBROUTINE  SOURCE  CODE 


U1 


XALINK.MAR 


.TITLE 
. I DENT 


XALINK 

/X-l/ 


*************************************************************************** 
*  * 

*  COPYRIGHT  (c)  1978,  1980,  1982,  1984  BY  * 

*  DIGITAL  EQUIPMENT  CORPORATION,  MAYNARD,  MASSACHUSETTS.  * 

*  ALL  RIGHTS  RESERVED.  * 

*  * 

*  THIS  SOFTWARE  IS  FURNISHED  UNDER  A  LICENSE  AND  MAY  BE  USED  AND  COPIED  * 

*  ONLY  IN  ACCORDANCE  WITH  THE  TERMS  OF  SUCH  LICENSE  AND  WITH  THE  a 

*  INCLUSION  OF  THE  ABOVE  COPYRIGHT  NOTICE.  THIS  SOFTWARE  OR  ANY  OTHER  * 

*  COPIES  THEREOF  MAY  NOT  BE  PROVIDED  OR  OTHERWISE  MADE  AVAILABLE  TO  ANY  * 

*  OTHER  PERSON.  NO  TITLE  TO  AND  OWNERSHIP  OF  THE  SOFTWARE  IS  HEREBY  * 

*  TRANSFERRED.  * 

*  * 

*  THE  INFORMATION  IN  THIS  SOFTWARE  IS  SUBJECT  TO  CHANGE  WITHOUT  NOTICE  * 

*  AND  SHOULD  NOT  BE  CONSTRUED  AS  A  COMMITMENT  BY  DIGITAL  EQUIPMENT  * 

*  CORPORATION.  * 

*  * 

*  DIGITAL  ASSUMES  NO  RESPONSIBILITY  FOR  THE  USE  OR  RELIABILITY  OF  ITS  * 

*  SOFTWARE  ON  EQUIPMENT  WHICH  IS  NOT  SUPPLIED  BY  DIGITAL.  * 


*************************************************************************** 
PROGRAM  TO  CHANGE  DR11W  DRIVER  FOR  LINK  MODE 


SYSTEM  MACRO  CALLS  -  DEFINE  XADRIVER  CHARACTERISTICS  BITS 


$XADEF 

;  LOCAL  SYMBOLS 

.PSECT  XADATA , LONG 

CHANA:  .LONG  0  ;  CELL  TO  STORE  CHANNEL  NUMBER 

IOSB :  . BLKQ  1  ;  IOSB  FOR  QIO 

CHARJBUF:  .LONG  80, INFO  ;  DEVICE  CHARACTERISTICS  BUFFER  DESCR 

LENGTH:  .LONG  0  ;  AND  LENGTH 

INFO:  .LONG  0  ;  CHARACTERISTICS  BUFFER 

CHAR :  . LONG  0 

DEVDEPEND:  .LONG  0 

. BLKL  20 


.PSECT  XACODE , NOWRT 

.ENTRY  XALINK, AM<R2,R3,R4,R5> 

MOVL  @4(AP) ,WaCHANA  ;  GET  CHANNEL  NUMBER 

20$: 

$GETCHN_S  CHAN=WaCHANA, -  ;  GET  CHANNEL  INFORMATION 
PRIBUF=WACHAR_BUF, - 
PRI LEN=WA  LENGTH 
BLBS  RO , 40$ 


RET 


40$: 


50$: 


BISL  #XA$M_LINK,WaDEVDEPEND 
$QIO_S  CHAN-WaCHANA, - 
FUNC-//IO$_SETCHARf  - 
EFN-y/10,  - 
IOSB-WaIOSB,- 
P1-WaCHAR 
BLBS  R0 , 50$ 

RET 

MOVZWL  WaIOSB,RO 

RET 

.END 


SET  LINK  MODE  STATUS  BIT 
WRITE  CHARACTERISTICS 
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XAMES SAGE. MAR 


.TITLE  XAMESSAGE 
. I DENT  ' V04-001 ' 

***************************************************************  ■*•*•**  ******* 


*  * 

*  COPYRIGHT  (c)  1978,  1980,  1982,  1984  BY  * 

*  DIGITAL  EQUIPMENT  CORPORATION,  MAYNARD,  MASSACHUSETTS.  * 

*  ALL  RIGHTS  RESERVED.  * 

*  * 


*  THIS  SOFTWARE  IS  FURNISHED  UNDER  A  LICENSE  AND  MAY  BE  USED  AND  COPIED  * 

*  ONLY  IN  ACCORDANCE  WITH  THE  TERMS  OF  SUCH  LICENSE  AND  WITH  THE  * 


*  INCLUSION  OF  THE  ABOVE  COPYRIGHT  NOTICE.  THIS  SOFTWARE  OR  ANY  OTHER  * 

*  COPIES  THEREOF  MAY  NOT  BE  PROVIDED  OR  OTHERWISE  MADE  AVAILABLE  TO  ANY  * 

*  OTHER  PERSON.  NO  TITLE  TO  AND  OWNERSHIP  OF  THE  SOFTWARE  IS  HEREBY  * 

*  TRANSFERRED.  * 

*  * 

*  THE  INFORMATION  IN  THIS  SOFTWARE  IS  SUBJECT  TO  CHANGE  WITHOUT  NOTICE  * 

*  AND  SHOULD  NOT  BE  CONSTRUED  AS  A  COMMITMENT  BY  DIGITAL  EQUIPMENT  * 

*  CORPORATION.  * 

*  * 

*  DIGITAL  ASSUMES  NO  RESPONSIBILITY  FOR  THE  USE  OR  RELIABILITY  OF  ITS  * 

*  SOFTWARE  ON  EQUIPMENT  WHICH  IS  NOT  SUPPLIED  BY  DIGITAL.  * 

*  * 

*  * 


*************************************************************************** 

++ 

FACILITY: 

VAX/VMS  Executive,  I/O  Drivers 
ABSTRACT : 

This  module  allows  you  to  connect  a  DR11-W  to  a  DRV11-WA;  or 
a  DR11-W  to  another  DR11-W  in  an  interprocessor  link  and  to 
perform  data  transfers  from  one  processor  to  the  other. 

AUTHOR:  Donald  G.  Blair 

MODIFIED  BY: 
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.  SBTTL 


LOCAL  DEFFINITIONS  AND  STORAGE 


++ 

XAMESSAGE  ROUTINE 
CALLING  SEQUENCE: 

CALL  (BUFFER_ADDRESS , BUFFER_SIZE , TRANSFER_DIRECTION, CHANNEL, - 

EVENT_FLAG , TIME_OUT , STATUS_ADDRESS , LOCAL_DEVICE , REMOTE_DEVICE) 

BUFFER_ADDRESS  -  ADDRESS  OF  DATA  BUFFER  TO  TRANSFER 
BUFFER_SIZE  -  SIZE  IN  BYTES  OF  DATA  BUFFER  TO  TRANSFER. 

NOTE  THAT  RECEIVER  AND  TRANSMITTER  MUST  AGREE  ON  THE 
SIZE  OF  THE  TRANSFER. 

TRANS FER_DIRECTION  -  DIRECTION  FOR  DATA  TO  GO 
0  -  TRANSMIT 
1  =  RECEIVE 

CHANNEL  -  CHANNEL  ASSIGNED  TO  DEVICE  (DR11-W  OR  DRV11-WA) 
EVENT_FLAG  =  EVENT  FLAG  TO  SET  WHEN  TRANSFER  COMPLETE 
TIME_OUT  =  I/O  TIME-OUT  VALUE  IN  SECONDS 
STATUS_ADDRESS  -  ADDRESS  OF  20  BYTE  ARRAY  TO  RECEIVE 
FINAL  STATUS  -  ONLY  FILLED  IN  IF  USER'S  PARAMETERS  ARE 
ALL  VALID. 

IOSB  -  8  BYTES 

I/O  STATUS  BLOCK  FROM  QUEUE  I/O  REQUEST 
ERROR  -  4  BYTES  -  NOT  USED  -  FOR  COMPATIBILITY 
WITH  OLD  VERSIONS  OF  THIS  MODULE. 

STATE  -  4  BYTES 

THIS  FIELD  TRACKS  WHICH  QIO  WAS  THE  LATEST 
ONE  TO  BE  PERFORMED. 

01  -  LAST  QIO  WAS  ONE  IN  THE  MAIN  ROUTINE 
02  -  LAST  QIO  WAS  ONE  IN  AST_GO . 

SSRV_STS  -  4  BYTES 

VALUE  OF  RO  RETURNED  FROM  THE  LAST  SYSTEM 
SERVICE  EXECUTED. 

LOCAL_DEVICE  =  TYPE  OF  DEVICE  AT  LOCAL  END  OF  LINK. 

DRI1_W  1 
DRV11_WA  =  2 

REMOTE_DEVICE  -  TYPE  OF  DEVICE  AT  REMOTE  END  OF  LINK. 

DR11_W  =  1 
DRVIL  WA  =  2 


$SSDEF 

;  PARAMETER  OFFSETS. 

BUFFER_P  -  4 
BUF_SIZE_P  -  8 
DIRECT ION_P  -  12 
CHAN_P  -  16 
EFN_P  -  20 
TIME_P  -  24 
STS  ADDR  P  -  28 
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LCL_DEVICE_P  -  32 
REM_DEVICE_P  -  36 

.PSECT  XADATA , LONG 

;  SAVED  PARAMETER  VALUES. 

BUFFER:  .LONG  0  ;  SAVED  BUFFER  ADDRESS 

BUFSIZE:  .LONG  0  ;  SAVED  BUFFER  SIZE 

DIRECTION:  .LONG  0  ;  DIRECTION  OF  TRANSFER 

CHAN:  .LONG  0  ;  SAVED  CHANNEL  ASSIGNED  TO  DR11-W 

EFN :  .LONG  0  ;  SAVED  EVENT  FLAG  NUMBER 

TIME:  .LONG  0  ;  SAVED  TIME-OUT  VALUE 

STS_ADDR :  .LONG  0  ;  ADDRESS  OF  CALLERS  STATUS  VARIABLE 

;  DEFINE  DEVICE  TYPES  AT  BOTH  ENDS  OF  INTERPROCESSOR  LINK. 

DR11_W  -  1 
DRV 1 1_WA  =  2 

LCL_DEVICE:  . BLKL  1  ;  TYPE  OF  DEVICE  ON  THIS  SYSTEM. 

REMDEVICE:  .BLKL  1  ;  TYPE  OF  DEVICE  AT  OTHER  END  OF  LINK. 

AST :  . BLKL  1 


;  NOTE  -  ORDER  IS  ASSUMED  FOR  NEXT  FOUR  VARIABLES 


IOSB:  .QUAD  0 
ERROR:  .LONG  0 
STATE:  .  .LONG  0 
SSRV  STS:  .LONG  0 


QIO  IOSB 

ERROR  VALUE  PARAMATER 
STATE  VARIABLE 
SYSTEM  SERVICE  STATUS 
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. SBTTL  VALIDATE  AND  SAVE  CALLER’S  PARAMETERS 

.PSECT  XACODE , NOWRT 

.ENTRY  XAMESSAGE, AM<R2,R3,R4,R5> 


;  VALIDATE  AND  SAVE  CALLER’S  PARAMATERS 


CLRQ  WAIOSB 
CLRL  WA ERROR 
CLRL  WASSRV__STS 
CMPW  (AP) , #9 
BEQL  10$ 

BRW  BADPARAM 


CLEAR  IOSB 

CLEAR  ERROR  FIELD 

CLEAR  SYS  SERVICE  RETURN  STATUS. 

MUST  HAVE  9  PARAMATERS 

BR  IF  OKAY 

BR  TO  SIGNAL  ERROR 


10$:  MOVL  BUFFER_P(AP) ,WA BUFFER  ;  GET  BUFFER  ADDRESS 
MOVL  @BUF_SIZE_P(AP) ,WABUF_SIZE  ;  GET  BUFFER  SIZE 
BNEQ  20$  ;  BR  IF  OKAY 


BRW  BADPARAM  ;  XFER  SIZE  IS  NON  ZERO  --  ILLEGAL 

20$:  MOVZBL  @DIRECTION_P(AP) , WADIRECTION  ;  GET  TRANSFER  DIRECTION  FLAG 
CMPL  WADIRECTION,#2  ;  THE  ONLY  LEGAL  VALUES  ARE  0,1 

BLEQU  25$  ;  BR  IF  OKAY 


BRW  BADPARAM  ;  ELSE  BR  TO  SIGNAL  ERROR 

25$:  MOVL  @CHAN_P(AP) ,WA CHAN  ;  FETCH  CHANNEL 
MOVL  @EFN_P(AP) ,WaEFN  ;  AND  EVENT  FLAG 


BEQL  BADPARAM  ;  MUST  SPECIFY  EVENT  FLAG 
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MOVL  @TIME_P(AP) , UPTIME  ;  FETCH  TIME-OUT  VALUE 
BNEQ  30$  ;  IF  NONZERO,  USE  IT. 

MOVZBL  #5,WaTIME  ;  ELSE  USE  SOME  "REASONABLE"  VALUE 

30$:  MOVL  STS_ADDR_P(AP) , WaSTS_ADDR  ;  GET  ADDRESS  OF  STATUS 

;  ARRAY 

BEQL  BADPARAM  ;  IF  NOT  SPECIFIED,  ERROR 

CLRL  @WaSTS_ADDR  ;  INITIALIZE  STATUS  VALUE 

MOVZBL  @LCL_DEVICE_P(AP) ,WALCL_DEVICE  ;  GET  LOCAL  DEVICE  TYPE 
CMPL  #DRV11_WA,WaLCL_DEVICE  ;  IS  LOCAL  DEVICE  A  DRV11-WA? 

BEQLU  35$  ;  BRANCH  IF  SO. 

CMPL  #DR11_W,WALCL_DEVICE  ;  IS  LOCAL  DEVICE  A  DR11-W? 

BNEQU  BADPARAM  ;  ERROR  IF  IT’S  NOT  EITHER. 

35$:  MOVZBL  @REM_DEVICE_P(AP) , WAREM_DEVICE  ;  GET  REMOTE  DEVICE 

;TYPE 

CMPL  y/ DRV  1 1_WA , W A REM_D EV I C E  ;  IS  REMOTE  DEVICE  A  DRV11-WA? 

BEQLU  50$  ;  BRANCH  IF  SO. 

CMPL  y/DRll_W,WAREM_DEVICE  ;  IS  REMOTE  DEVICE  A  DR11-W? 

BNEQU  BADPARAM  ;  ERROR  IF  IT'S  NOT  EITHER. 

50$:  $CLREF_S  EFN=EFN  ;  MAKE  SURE  EFN  IS  CLEAR 

BLBS  RO , 100$  ;  BR  IF  NO  SYS  SERVICE  ERROR 

RET 

100$:  CMPL  //DRV11_WA,WALCL_DEVICE  ;  DISPATCH  BASED  ON  LOCAL  DEVICE  TYPE 

BEQL  DRV 11_WA_S TART  ;  LOCAL  DEVICE  IS  DRV11-WA 

BRW  DR1 1_W_START  ;  LOCAL  DEVICE  IS  DR11-W 

BADPARAM : 

MOVZWL  y/SS$_BADPARAM , RO  ;  ELSE  RETURN  ERROR. 

RET 
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.  SBTTL  START  MESSAGE  PROCESSOR 


DRV11_WA_START:  ;  THE  LOCAL  DEVICE  IS  A  DRV11-WA 

BLBC  INDIRECTION, 10$  ;  BRANCH  IF  IT'S  A  XMIT  OPERATION 

MOVAL  WaAST_COMPLET!ON,WaAST  ;  AST  COMPLETION  IS  THE  AST  FOR  RECEIVE 
BRB  20$ 

10$:  MOVAL  WaAST_G0,WaAST  ;  AST_GO  IS  THE  AST  FOR  XMIT  OPERATION 

20$:  MOVL  y/OI,WASTATE  ;  STATE  =  1  ->  LAST  QIO  WAS  IN  MAIN 


;  RO'  TINE. 

$QIO_S  CHAN=WaCHAN, -  ;  BLOCK  MODE  READ  -  EVEN  IF  IT’S  XMIT 

FUNC=//<IO$_READLBLK !  IO$M_TIMED!  IO$M_SETFNCT> ,  - 
IOSB=WAIOSB, - 
ASTADR=@WaAST, - 

Pl=<awABUFFER,  -  ;  ADDRESS  OF  CALLER'S  DATA  BUFFER 

P2=WABUF_SIZE, -  ;  LENGTH  OF  DATA  BUFFER 

P3=WaTIME,-  ;  TIMEOUT  VALUE 

P4-//7  ;  INTERRUPT+READ 

BRW  MAIN  EXIT  ;  EXIT  MAIN  ROUTINE. 


DR11_W_START:  I  LOCAL  DEVICE  IS  DR11-W 

MOVL  //01,WASTATE  ;  STATE  =  1  =>  LAST  QIO  WAS  IN  MAIN 

;  ROUTINE. 

$QIO_S  CHAN=WaCHAN, -  ;  QIO  TO  ENABLE  AST'S 

FUNC-//<IO$_SETMODE !  IO$M_ATTNAST> ,  - 


Si 


iosb«waiosb,  - 
pi=waast_go 

BLBC  RO , MAIN_EXIT  ;  BRANCH  ON  ERROR  -  ALL  DONE. 

BLBS  INDIRECTION, MAIN_EXIT  ;  BRANCH  IF  IS  A  RECEIVE  OPERATION 

CMPL  #DR11_W,WAREM_DEVICE  ;  IS  REMOTE  DEVICE  A  DR11-W? 

BNEQU  MAIN_EXIT  ;  BRANCH  IF  NOT. 

$QIO_S  CHAN=WaCHAN, -  ;  PERFORM  0- LENGTH  QIO.  THIS 

FUNC=#<IO$_URITELBLK! IO$M_SETFNCT> , -  ;  SERVES  TO  SET  THE 
IOSB=WAIOSB, -  ;  FNCT  BITS  (CONTAINED  IN  P4) , 

P1=@WABUFFER, -  ;  IN  THE  CSR,  INTERRUPTING  THE  REMOTE 

P2-//0 ,  -  ;  DR11-W. 

PH2 

MAIN_EXIT: 

MOVL  RO,WaSSRV_STS  ;  SAVE  QIO  STATUS  RETURN 

MOVC 3  #20 , WA IOSB , @WA STS_ADDR  ;  RETURN  STATUS  TO  THE  USER 

BLBS  WASSRV_STS,10$  ;  IF  SUCCESS,  DON'T  SET  EVFLAG  YET 

$SETEF_S  EFN=WAEFN  ;  IF  ERROR,  SET  EVENT  FLAG  --  ALL  DONE. 

10$:  MOVL  WASSRV_STS,RO  ;  RESTORE  RO  STATUS  RETURN. 

RET 
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.  SBTTL  AST_GO  -  AST  WHICH  INITIATES  THE  QIO  TO  PERFORM  ACTUAL  XFER . 
.ENTRY  AST_GO,aM<R2iR3,R4,R5> 


This  AST  is  called  to  perform  the  $QIO  which  begins  the  actual  transfer 
of  user  data.  (Hence  the  name  AST_GO.) 

BLBS  WaDIRECTION,AST_RECEIVE  ;  BRANCH  IF  RECEIVE  OPERATION 


;  On  a  DR11-W,  this  AST  is  delivered  as  a  result  of  an  interrupt  from  the 
;  remote  device,  so  no  status  checking  is  necessary.  On  a  DRV11-WA,  this 
;  AST  is  delivered  as  a  result  of  an  intentionally  pjmature  I/O 
;  completion,  so  we  expect  the  status  return  to  be  5 :>$_OPINCOMPL. 

» 

ASTXMIT : 

CMPL  #DRV11_WA,WaLCL_DEVICE  ;  IS  LOCAL  DEVICE  A  DRV11-WA? 

BNEQ  20$  ;  BRANCH  IF  NOT. 

CMPW  WAIOSB,#SS$_OPINCOMPL  ;  STATUS  SHOULD  BE  SS$_OPINCOMPL . 

BEQL  20$  ;  BR  IF  EXPECTED  STATUS 

BRW  IO_DONE  ;  ELSE  ERROR 

20$:  MOVL  #02,WaSTATE  ;  STATE  =  2  =>  LAST  QIO  WAS  IN 

;  AST_GO . 

$QIO_S  CHAN=WaCHAN, -  ;  BLOCK  MODE  WRITE 

FUNC=#<IO$_WRITELBLK ! IO$M_TIMED ! IO$M_SETFNCT ! IO$M_CYCLE> , - 
IOSB=WAIOSB, - 
ASTADR=WaAST_COMPLETION, - 

Pl=<aWABUFFER,  -  ;  ADDRESS  OF  CALLER1'  DATA  BUFFER 

P2-WaBUF_SIZE, -  ;  LENGTH  OF  BUFFER 

P3-WaTIME,-  ;  TIMEOUT  VALUE 

P4-#4  ;  FNCT  BITS  FOR  CSR 

BLBS  RO , 40$  ;  RETURN  IF  QIO  STARTED  OK 


BRW  IO_DONE  ;  ALL  DONE  IF  ERROR  OCCURRED. 

40$:  RET  ;  DISMISS  THIS  AST,  AND 

;  WAIT  FOR  AST_COMPLETION 

;  AST_RECEIVE  is  only  used  by  the  DR11-W,  since  the  DRV11-WA  initiates 
;  the  actual  data  transfer  from  the  main  routine  when  it  is  the  receiver. 

AST_RECEIVE : 

MOVL  #02, WA STATE  ;  STATE  -  2  ->  LAST  QIO  WAS  IN  AST_G0. 

$QI0_S  CHAN-WaCHAN, -  ;  BLOCK  MODE  READ 

FUNC-#<IO$_READLBLK! IO$M_TIMED! I0$M_SETFNCT>, - 

iosb-waiosb, - 

ASTADR“WaAST_COMPLETION, -  ;  ADDRESS  OF  AST  FOR  I/O 
; COMPLETION 

P1-@WA BUFFER, -  ;  ADDRESS  OF  CALLER'S  DATA  BUFFER 

P2-WABUF_SIZE, -  ;  LENGTH  OF  DATA  BUFFER 

P3“WATIME,-  ;  TIMEOUT  VALUE 

P4-#7  ;  INTERRUPT+READ 

BLBS  RO , 10$  ;  RETURN  IF  QIO  STARTED  OK 

BRW  IO_DONE  ;  ON  ERROR,  WE'RE  ALL  DONE. 

10$ :  RET 
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. SBTTL  AST_COMPLETION  -  COMPLETION  ROUTINE  FOR  I/O  TRANSFER. 

. ENTRY  AST_COMPLETION , AM<R2 , R3 , R4 , R5> 

;  This  AST  is  called  when  the  actual  transfer  of  data  is  complete.  Note 
;  that  the  status  value  in  the  IOSB  must  be  checked  by  the  caller  when 
;  we're  done. 

;  IO_DONE  is  also  called  when  an  error  occurs  and  the  handshaking 
;  sequence  must  be  re i minated . 

IO_DONE : 

MOVC 3  //20,WaL;SB,@WaSTS_ADDR  ;  RETURN  STATUS  TO  THE  USER 
$SETEF_S  EFN=WaEFN  ;  SET  THE  CALLER'S  EVENT  FLAG 

MOVZBL  #SS$_NORM aL.RO  ;  SIGNAL  SUCCESSFUL  AST 

.COMPLETION. 

RET 

.END 
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DR11  SEND  RECEIVE. FOR 


c****************************** ********************************* 


SUBROUTINE  DR11  SEND  RECEIVE  ( 


& 

& 

& 

& 

& 

& 

& 


xmit_operation, 
data_buf fer , 
buf fer_size , 
local , 
remote , 
master 
) 


’*****************■*****************************■******■****■*■*•■*■**** 


implicit  none 

C  •**•*****■*"**'*•  -k  -k-k  ~k  ******  -k  **********  *  **********  ■*  *■*■****■*■*■*•■*•■*  -A-*****  *  it  * 

c  VARIABLE  DECLARATIONS 

c ************ ************ *************************************** 


integer*''* 

integer*/* 

integer*/* 

integer*/* 

integer*/* 

integer*/* 

integer*/* 

integer*/* 


local , remote , buf fer_size 
status , nchan , indx 
time  /30/ 
xmit_operation 
iosb (10) 

sys$assign, sys$waitfr 
xaiv.essage ,  xal  ink 
data_buf fer (400) 


logical  linked  /.FALSE./ 

logical  master 


C ***************************************************  ************ 

C  CHARACTER  DECLARATIONS 

c ***************************************** **********  * *********  *** 


character  DEVICE*5/ ' XAAO : ' / 
external  xal ink , xamessage 

c ************************************* ************************** 

c  Begin  Executable  Code 

c ************  A^*****^****************************************** 


c...  assign  channel  to  DR11-W  and  place  xadriver  in  LINK  mode  for 
C  this  channel 

if  (.NOT.  linked)  then 

status=sys$assign( ' XAAO : ' , nchan , , ) 
if(.not.  status) go to  100 
status=xal ink(nchan) 
if(.not.  status)goto  150 
linked  -  .TRUE. 
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endif 


10  continue 

c  call  xamessage  routine  to  exchange  data; 

c...  xmit_operation  -  1  for  receive,  0  for  transmit 

status-xamessage( 

&  data_buffer, 

&  buf fer_size*2 , 

&  xmit_operation, 

&  nchan, 

&  12, 

&  time, 

&  iosb, 

&  local, 

&  remote  ) 

if(.not.  status)goto  200 

status»sys$waitfr(%val(12) ) 
if(.not.  status)goto  300 

goto  50  !  let's  exit  go  back  for  next  iteration 


c  .  .  . 

Error  messages 

100 

write (6 , 1010) status 

1010 

format('  error  from 
call  exit 

assign  ' , i8) 

150 

write (6 , 1015) status 

1015 

format('  error  from 
call  exit 

xalink  ' , i 8 ) 

200 

write (6 , 1020) status 

1020 

format('  error  from 
goto  50 

xamessage  ' , 

300 

write (6 , 10 30) status 

1030 

format('  error  from 

t. 

rr 

i-t 

CO 

50 

continue 

return 

end 
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UPDATE  TO  VAX. FOR 


c*************************************************************** 


SUBROUTINE  UPDATE  TO  VAX 


c*************************************************************** 

INCLUDE  ' [HELHAC. FOR] HAC1. INC/LI ST' 

INCLUDE  ' [HELHAC. FOR] HAC 2. INC/LI ST' 

INCLUDE  ' [HELHAC. FORJHAC3. INC/LIST' 

INCLUDE  ' [HELHAC. FOR ]HELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR ]FLTDATA. INC/LIST' 

INCLUDE  ' SYS$SHARE:MOVGBL. INC/LIST'  1T.A.B.  4/7/88 


integer*4  i_mox(10) , i_moy(10) , i_moz(10) 


real*4  r_mou(10) , r_mophi(10) , r_mohead(10) , r_mothet(10) 


c...  This  conunon  contains  the  data  to  be  sent  to  the  VAX  11/780 

common  /zzl_snd_data/ 

&  r_airspeed,  r_torque ,  r_rclimb, 

&  r_altitude,  r_roll,  r_pitch, 

&  r_yaw.  r_slip,  r_cosphi, 

&  r_sinphi,  r_ugnd,  r_vgnd, 

&  r_dei: ,  r_dnr,  r_ve,  r_vn, 

&  r_phi,  r_thet ,  r_psi,  r_turn_rate, 

&  i_mox,  i_moy,  i_moz ,  r_mou, 

&  r_mohead,  r_mophi ,  r_mothet 

C...  Begin  executable  code. 


r_airspeed 

- 

UB 

r_torque 

=■ 

QRAPCT 

r_rclimb 

= 

ALTD 

r_altitude 

- 

ALT 

r_roll 

- 

PHIR 

r_pitch 

- 

THETR 

r_yav 

- 

PSIR 

r_slip 

- 

VB 

r_cosphi 

- 

CPHI 

r_sinphi 

- 

SPHI 

r_ugnd 

- 

UB 

r_vgnd 

- 

VB 

r_der 

- 

DER 

r_dnr 

- 

DNR 

r_ve 

- 

VE 

r_vn 

- 

VN 

r_phi 

- 

PHI 

r_thet 

- 

THET 

r_psi 

- 

PSI 
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r  turn  rate 


TURN  RATE  !MCL  07-22-1988  GLH 


DO  45  1-1,10 
i_moxf i) 
i_moy ( i ) 
i_moz(i) 
r_mou( i) 
r_mohead(i) 
r_mophi(i) 
r_raothet(i) 
45  CONTINUE 


MOX(I) 

M0Y(1) 

MOZ(I) 

MOU(I) 

MOHEAD ( I ) 

MOPHI(I) 

MOTHET ( I ) 


return 

end 
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U  P  DAT  E_  FROM_VAX . FOR 

c***************sHt********************************************** 
SUBROUTINE  UPDATE_FROM_VAX 

C******-********************************************************* 

INCLUDE  ' [HELHAC. FOR JHELGBL. INC/LI ST' 

INCLUDE  ' [HELHAC . FOR] FLTDATA. INC* 
c...  This  common  contains  the  data  to  be  received  to  the  VAX 
C  11/780 

character*4  c_key_INPUT 

common  /zzl_rcv_data/ 

&  i_hel_world_x ,  i_hel_world_y , 

&  c_key_input 

C...  Begin  executable  code. 

hel_world_x 
hel_world_y 
key_input 

return 
end 


-  i_hel_world_x 

-  i_hel_world_y 

-  c_key_input 
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HACDATA . FOR 


SUBROUTINE  HACDATA 

C*************************************************************** 
C  HAG  DATA  INITIALIZATION 

C*************************************************************** 

INCLUDE  ' (HELHAC. FOR] HAC1. INC/LIST' 

INCLUDE  ' [HELHAC. FOR]HAC2. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] HAC3 . INC/LIST' 

INCLUDE  ' [HELHAC. FOR] FLTDATA. INC/LIST' 


G  -  32.174  ! adDFD  6/23/87 


HLEV-36089. 

XM1-1. 

PRESZ-2116 . 2 
TEMPZ-518 . 69 

c 

YCON-IOO.O 

! changed  due  to  problems 
'.with  rho  MCL  19-30-1987 

YCON  —  1.0 

TEMA-. 59249 

ICOND-1 

!  ADDED  6/16/87  GLH 

RHO—  .0023671 

! slug/f t3  added  6/16/87 

RHOZ-. 0023671 

! SLUG/FT3  ADDED  6/23/87  GLH 

SOUND-1140. 

!  ADDED  6/16/87  GLH 

S0UNDZ-1140. 

! ADDED  6/16/87  GLH 

IETURB-0 

! ADDED  6/17/87  GLH.  Changed 

c 

to  0 

c 

XP=4. 58330 

3/31/88  GLH. 

! ADDED  6/17/GLH 

YP=0 . 0 

! ADDED  6/17/87  GLH 

ZP-0 . 0 

! ADDED  6/17/87  GLH 

XMASS-497. 36 

! ADDED  6/19/87  GLH 

WAIT-16002. 

! ADDED  6/24/87  GLH 

RE-20924640. 

! radius  of  earth  in  feet 

c 

RR  =  RE 

added  6/23/87  GLH 
!  RAD .  OF  EARTH  +  HT.  OF 

c 

I FLAT- 1 

RUNWAY  8/26/87  TAF 
! ADDED  6/23/87  GLH 

DT2-0.06 

! ADDED  6/19/87  GLH, CHANGED  FROM 

TO 

c 

CTHT-1.0 

.06  7/21/88 
! ADDED  6/23/87  GLH 

R2D-57. 2957795 

! ADDED  6/23/87  GLH 

c--- 

--PILOT  INPUTS, LIMITS, 

DEADBANDS,  GAINS 

ROLLO 

0.0 

PITCHO 

0.0 

YAWO 

0.0 

ROLMAX 

50. 

PITMAX 

50. 
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YAWMAX 

= 

50. 

COLOMIN 

- 

100.0 

COLOMAX 

- 

100.0 

RDBO 

= 

6.0 

! CHANGED  9/16/87 

GLH 

PDBO 

= 

6.0 

{CHANGED  9/16/87 

GLH 

YDBO 

= 

3.0 

{CHANGED  9/16/87 

GLH 

CDBO 

= 

0.0 

C--- 

--GAINS  FOR  +-50(  OOC 

i  »  50/INCHES  OF  TRAVEL) 

c 

OOOG1 

= 

8.33 

OOOG1 

= 

5.33 

{roll 

c 

OOOG2 

8.33 

OOOG2 

= 

3.00 

! p i tch 

c 

OOOG3 

- 

15.625 

OOOG3 

= 

3.5 

c 

000G4 

- 

-10.0 

000G4 

= 

-9.0  ! 

GLH  5  OCT  87 

c 

000G4 

= 

-12.0 

!mcl  19-aug-1987 

000B4 

= 

0.0 

c--- 

---MAG  BRAKE  AND 

BEEPER  TRIM 

IMBC 

= 

0 

ILITE 

= 

1 

GNUD 

- 

0.5 

GRLD 

= 

0.5 

C . LOADER  RATE  LIMIT  (  INCHES/CYCLE  ) 

TINCIC  =  1.0 

TINCOP  -  0.25 


C . INITIAL  TRIM  POINT 

TRIMl  -  0. 

TRIM1C  -  0. 

TRIM1P  -  0. 

TRIM2  -  0. 

TRIM2C  -  0. 

TRIM2P  -  0. 

TRIM3  =  0. 

TRIM3C  -  0. 

TRIM3P  -  0. 

TRIM4  -  0 . 

TRIM4C  =  0. 

TRIM4P  -  0. 

C . I COZERO- 1  FOR  SUBTRACTING  IC  VALUES  FROM  PILOT  INPUTS 

I COZERO  =  1 

C . COLLECTIVE  POSITION  LIMITS  AND  %BIAS. 

COLMINT  =  0.0 
COLMAXT  =10.0 
PCTBIAS  =0.0 

C. . .GRADIENTS,  BREAKOUTS,  HYSTERI SIS --- NOMINAL  VALUES . 
PEDBRK  =2.0 
PEDGRD  =2.0 
PCHBRK  =1.0 
PCHGRD  =0.67 
ROLBRK  =1.0 
ROLGRD  =1.0 
CLCFRC  =0.5 
CLCGRD  =0.0 
CLCBRK  =0.0 
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CBAUTO  -  0.0 
CGAUTO  -  0.0 
CFMAN  -  10.0 
CFAUTO  -  1.0 
COLHYS  -  0.0 
ROLHYS  -  0.0 
PEDHYS  -  0.0 

C . CONTROL  SYSTEM  OPTION  FLAG. 


ICS  -  2 

MCS  -  1 

• 

ICONFI 

-  2 

IALLMULAX  -  0  ! 

when  set  to  1  multiaxis 

roll, pitch,  yaw, and  collective  are  used. 

- 

XNV 

2.50 

! CHANGED  6/17/87  GLH 

XRT 

0.0 

YRT 

0.0 

XUT 

-0.01 

YVT 

-0.1 

ZWT 

-1.0 

ZDCT  - 

1.5 

ZLPT  - 

-2.8 

ZMQT  - 

-2.8 

ZNRT  - 

-2.0 

XNDPT  - 

0.04 

XKDP  - 

0.0209 

FPS2KOS 

-  0.592485 

ZUO 

1.0 

XLPHIO  - 

-6.25 

C . SENSITIVITY  CONSTANTS. 

ZLVT  -1.0 

ZMUT  -  0.3  !  Changed  from  1.0  to  0.3  4/4/88  GLH 

ZMWT  -  0.2  !  Changed  from  1.0  to  0.2  4/4/88  GLH 

ZNVT  -1.0 

ZUT  —  1.0 

ZWTT  =  1.0 

ZMU  —  0.0 

ZLV  -0.0 

C . CONTROL  SYSTEM  DEPNDENT  PARAMETERS 


ICS  - 
XLPHI1 

1, 

0.0 

XLPHI2 

- 

-6.25 

XLPHI3 

- 

-6.25 

ZLPD 

- 

-5.6 

ZMQD 

- 

-5.6 

ZMQ1 

= 

-5.6 

ZMQ2 

- 

-3.5 

ZLP1 

- 

-5.6 

ZLP2 

- 

-3.5 

XLDAl 

- 

0.2 

XLDA3 

- 

0.2 

XMDE1 

- 

0.14 

XMDE3 

- 

0.1 

C . FTZ  LIMITING 

C . V-N  CURVE  FOR  UH-60  HELICOPTER. 

VQMAX(l)  -  0.0 
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RTMAX(l) 

- 

3.3 

VQMAX(2) 

- 

120.0 

RTMAX(2) 

- 

2.42 

VQMAX(3) 

■» 

160.0 

RTMAX ( 3 ) 

- 

2.10 

VQMAX ( 4 ) 

- 

180.0 

RTMAX ( 4 ) 

= 

1.58 

VQMAX ( 5 ) 

190.0 

RTMAX(5) 

= 

1.58 

VQMAX(6) 

= 

200.0 

RTMAX(6) 

- 

1.58 

VQMIN(l) 

= 

0.0 

RTMIN(l) 

= 

0.6 

VQMIN(2) 

- 

54.0 

RTMIN(2) 

- 

0.0 

VQMIN(3) 

- 

154.0 

RTMIN(3) 

- 

0.0 

VQMIN(4) 

= 

180.0 

RTMIN(4) 

= 

0.5 

VQMIN(5) 

190.0 

RTMIN(5) 

- 

0.5 

VQMIN(6) 

= 

200.0 

RTMIN(6) 

= 

0.5 

C . COLLECTIVE  TRIM  .  (  13MAY85) . 


SLP1 

= 

0.25 

YINTl 

= 

50.6 

SLP2 

= 

-0.25 

YINT2 

- 

50.6 

SLP3 

= 

0.0 

YINT3 

= 

40.8 

SLP4 

= 

0.27 

YINT4 

- 

16.5 

SLP5 

- 

0.72 

YINT5 

= 

-46.7 

AIRCRAFT 

CONFIGURATION: 

ICON=l 

.LOW  BASELINE. 

AH-  IS 

2 

.HIGH  BASELINE. 

UH-60 

3 

.  LHX. 

LHX. 

C . RATE  OF  CLIMB  . 

RSLPl(l)  ---  0.176 
RSLPl (2)  =  0.11 
RSLPl(3)  -  0.08 
XINTl(l)  -  14.4 
XINT1 (2 )  -  31.1 
XINT1(3)  =  38.8 
RSLP2(1)  =  -0.192 
RSLP2(2)  -  -0.252 

c  RSLP2 (2)  =  -0.150  !mcl  19-aug-1987 

RSLP2(3)  -  -0.252 
XINT2(1)  =  40.13 
XINT2 (2)  -  56.42 

c  XINT2 (2)  -  70.00  Imcl  19-aug-1987 

XINT2(3)  -  62.03 

C . SIDESLIP  LIMITATION  ENVELOPE  . 

ESLPl(l)  =  -2.0 
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n  n  n  n  o  no 


ESLP1(2)  -  -1.082 
ESLP1(3)  -  -0.932 
EINTl(l)  -  150.0 
EINT1(2)  -  138.68 
EINT1(3)  -  145.92 
ESLP2(1)  -  -0.16 
ESLP2(2)  -  -0.146 
ESLP2(3)  -  -0.146 
EINT2(1)  -  30.4 
EINT2(2)  -  40.4 
EINT2(3)  -  51.6 
VEQPT(l)  -  65.0 
VEQPT ( 2 )  -  105.0 
VEQPT(3)  -  120.0 
C. . .MAXIMUM  RATE  OF  DESCENT  . 

RODSLP  -  0.114286 
ROD INTI  -  -20.0 
ROD I NT 2  -  -4.00 

C . INITIAL  THETA  FOR  ZRT  CALCULATION. 

THETIC  -0.0 
THETVIC  -  0.0 

C... THETA  OFFSET  FOR  INITIALIZATION  PURPOSES. 

THETOFF  =0.0 

C . COLLECTIVE/ENGINE  FILTER  TIME  CONSTANT  AND  GAIN 

TAUCOL  -  0.1 
GCOL  -1.0 

. PERCENT  LIMIT  FOR  FTZ  APPROACH. 

. TIME  DELAY  FOR  ONSET  OF  FTZ  RED  G- LIMIT  LIGHT: 

APPPCT  -  10.0 

REDTIME  -  0.5 

. SOUND  GENERATOR  VOLUMES 

SGVOLIC  -  0.0 
SGVOLOP  -  1.5 

...I.C.  COLLECTIVE  TRTM  SWITCH. 

LTRIM  -  0 

. BETAHUD  FUDGE  FACTOR 

BETAFG  =  .4678 

D2R  =  .01745  ! ADDED  6/23/87 

XLONR  =350.  *  D2R  ! ADDED  8/26/87 

XLATR  =  50.  *  D2R  ! ADDED  8/26/87 

CLATR  =  COS (XLATR) 

. HEADING  INITIALIZATION 

C 

PSIR  -  270.0/R2D  ! . Added  MCL  01/22/1988 

C 

RETURN 

END 
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o  o 


SCALEAD . FOR 


C****************************-*********************************** 


SUBROUTINE  SCALEAD 

c 

Author:  Finley 

c 

C 

This  program  scales  the 

input  from  the  A/D 

c 

c 

Subroutines  called: 

c 

none 

c 

Files  opened: 

c 

none 

c 

c 

Files  included: 

c 

[ HELHAC . FOR ] HAC 1 . INC 

c 

[ HELHAC . FOR] HAC 2 .INC 

c 

[ HELHAC . FOR ] HAC3 . INC 

c 

[ HELHAC . for ] HELGBL . INC 

c 

[ HELHAC . FOR ] FLTDATA . INC 

c 

Global  section  name: 

c 

HACSEC 

c 

INPUTS : 

c 

chad(l) 

Pitch 

c 

chad(2) 

Roll 

c 

chad(3) 

Collective  (conventional) 

c 

chad (4) 

Pedals  (conventional) 

c 

chad(5) . 

-Collective  from  multiaxis  control 

c 

chad(6) . 

-Yaw  from  multiaxis 

c 

pitscalar , rolscalar , 

c 

colscalar , pedscalar 

c 

colscalar  mulax, 

c 

pedscalar  mulax  Scaling  factors. 

c 

pitof fset , rolof fset , 

c 

coloffset.pedoffset 

c 

coloffset  mulax, 

c 

pedoffset  mulax  Offset. 

c 

imode 

Flight  mode. 

c 

c 

OUTPUTS : 

c 

pitchop 

Pitch . 

c 

rollop 

Roll. 

c 

colop 

Collective . 

c 

yawop 

Pedals . 

C*******************************************-*********  ■***■*  ******* 

INTEGER*4  torquep 

INCLUDE  ' [ HELHAC. FOR] HAC 1. INC/LI ST' 

INCLUDE  ' [HELHAC. F0R]HAC2. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] HAC3. INC/LIST' 

INCLUDE  ' [HELHAC. for] 

HELGBL. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] 

FLTDATA. INC/LIST' 
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IF  ((IMODE  .EQ.  -1)  .OR. 

&  (IMODE  .EQ.  1))  THEN 

C. . .Added  by  MCL  01/26/1988 
IF  (ALT  .LE.  0.0)  THEN 
IF  (UB  .GT.  1.0)  THEN 
CHAD ( 1 )  -  800 
ELSE 

IF  (UB  .LT.  -1.0)  THEN 
CHAD ( 1 )  -  -800 
ELSE 

CHAD(l)  -  0 
END  IF 
END  IF 

CHAD ( 2 )  -  0 
CHAD (4)  -  0 
CHAD ( 6 )  -  0 
END  IF 

C.  .  . 

CALL  GET_AD_VAL(torquep) 

c .  .  . 

PITCHOP  -PITSCALAR  *  CHAD(l)  +  PITOFFSET 
ROLLOP  -  ROLSCALAR  *  CHAD(2)  +  ROLOFFSET 
c... Added  by  GLH  6/22/88  to  use  full  multiaxis  inputs, 
c. . .If  IALLMULAX  is  1  then  the  conventional  pedals  and 
c . . . collective 

c.  .controls  are  not  used.  All  multiaxis  control  features 
c. . . are  used. 

I F ( IALLMULAX  . EQ . 0)THEN 

COLOP  -  COLSCALAR  *  CHAD(3)  +  C0L0FFSET 
YAWOP  -  PEDSCALAR  *  CHAD (4)  +  PEDOFFSET 

ELSE 

COLOP  -  COLSCALAR  *  CHAD(5)  +  COLOFFSET 
YAWOP  -  PEDSCALAR  *  CHAD(6)  +  PEDOFFSET 
END  IF 

IF( PITCHOP . GT . 10 . ) PITCHOP=10 . 

IF( PITCHOP. LT. -10. ) PITCHOP— 10. 

IF(ROLLOP.GT. 10 . )ROLLOP=TO . 

IF (ROLLOP . LT . - 10 . ) ROLLOP-- 10 . 

IF(COLOP . GT . 10 . )COLOP=10 . 

I F( COLOP . LT . 0 . )COLOP=0 . 

IF(YAWOP.GT. 10. )YAWOP=10. 

IF(YAWOP . LT . - 10 . ) YAWOP-- 10 . 

ELSE  !When  trimming 

PSTK  -  PITSCALAR  *  CHAD(l)  +  PITOFFSET 
RLSTK  -  ROLSCALAR  *  CHAD(2)  +  ROLOFFSET 
IF( IALLMULAX  . EQ . 0)THEN 
CLSTK  -  COLSCALAR  *  CHAD(3)  +  COLOFFSET 
RDSTK  -  PEDSCALAR  *  CHAD(4)  +  PEDOFFSET 
ELSE 

CLSTK  -  COLSCALAR  *  CHAD(5)  +  COLOFFSET 
RDSTK  -  PEDSCALAR  *  CHAD(6)  +  PEDOFFSET 
END  IF 
C 
C 
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IF( PSTK . GT , 10 . ) PSTK=10 . 
IF(PSTK. LT . -10. )PSTK=-10. 
IF(RLSTK . GT . 10 . )RLSTK=10 . 
IF(RLSTK. LT . - 10 . )RLSTK=- 10 . 
IF( IALLMULAX  .EQ.  0)THEN 

IF(CLSTK . GT . 10 . )CLSTK=10 . 
I F ( CLSTK . LT . 0 . ) CLSTK=0 . 

ELSE 

IF( CLSTK. GT. 10. )CLSTK=10. 
IF(CLSTK.LT. -1C. ) CLSTK- -10. 
ENDIF 

IF(RDSTK . GT . 10 . )RDSTK=10 . 
IF(RDSTK.LT. - 10 . ) RDSTK=- 10 . 
ENDIF 
RETURN 
END 
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GET_AD_VAL . FOR 

(]■*■*•******•*******■*****•********************■*************■*■*■******** 
Subroutine  gef_ad_val(torquep) 

C*************************************************************** 
IMPLICIT  NONE 

INTEGER*4  torque_max_of fset 
INTEGER*4  torque_min_offset 
INTEGER*4  torque_change 
INTEGER*4  torquep 

INCLUDE  ' (helhac.for]hac3.inc' 

c . 

torque_max_offset  -  100 
torque_min_offset  -  -100 

c...Find  the  change  in  torque 

IF  (chad(5)  .GT.  torque_max_offset)  THEN 
torque_change  =  chad(5)  -  torque_max_of fset 
ELSE 

IF  (chad(5)  .LT.  torque_min_of fset)  THEN 
torque_change  —  chad(5)  -  torque_min_of fset 
ELSE 

torque_change  =  0 
ENDIF 
END  IF 

c... Apply  the  change  in  torque 

chad(5)  -  torquep  +  torque_change 
IF  (chad(5)  .GT.  3000)  chad(5)  -  3000 
IF  (chad( 5)  .LT.  -3000)  chad(5)  -  -3000 
torquep  ■=  chad(5) 

RETURN 

END 
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CONTRL . FOR 


C  TITLE  CONTRL 

C 

C 

SUBROUTINE  CONTRL 
C 
C 
C 

(J********************************************************** 

C************  SUBROUTINE  ABSTRACT  AND  HIERARCHY  ******* 

C********************************************************** 

c 

c 

C  ROUTINE  PROVIDES  FOR  HELICOPTER  CONTROLS. 

C  IT  REQUIRES  A  MODIFIED  SMART. 

C 

C 

C********************************************************** 

c************  CREATION  AND  MODIFICATION  LOG  ******* 

C********************************************************** 


C 

C 

C  6/25/87  CREATED  FROM  CONTR2 . FOR  ,GLH 

C ********************************************************** 
C*************  SIGNIFICANT  VARIABLES  ************ 


C 

C 

C- 

C- 

C- 

C 


INPUTS 


c 

ROLLOP 

: LATERAL  CYCLIC 

+  - 

6 

INCHES 

c 

PITCHOP 

: LONGITUDINAL  CYCLIC 

+  - 

6 

INCHES 

c 

YAWOP 

: PEDAL 

+  - 

3.5 

INCHES 

c 

COLOP 

: COLLECTIVE 

0 

-  10 

INCHES 

ICS  CONTROL  SYSTEM  TYPE:  RATE  COM/ATT.  HOLD 

PURE  RATE  COMMAND 
ATT.  COM. /ATT.  HOLD. 

ICONFI  CRAFT  CONFIGURATION:  UH60 .  AH1S  OR  LHX . 


APPPCT  APPROACH  PERCENT,  0-100 

PERCENT  OF  FULL  ENGINE  POWER  FOR  YELLOW  LIGHT 
REDTIME  TIME  AT  100  PERCENT  TORQUE  FOR  RED  LIGHT 


INCLUDE  ' [ HELHAC . FOR ] HACl . INC/LTST' 

INCLUDE  ' [ HELHAC . FOR ] HAC2 . INC/LIST' 
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c 

c********************************************************** 
C*****************  EXECUTABLE  CODE  ******************* 
C********************************************************** 
C 
C 

IF  (  IMODE  )  10  ,  9999  ,  100 

C********************************************************** 
C***************  I.  C.  SECTION  ********************* 

C********************************************************** 

C 

10  CONTINUE 
C 
C 

C . CALCULATE  SLOPES  AND  INTERCEPTS  FOR  FTZ  LIMITS. 

C 

DO  15  JJ-1,5 

SLPMX(JJ)  = ( RTMAX ( J J  + 1 ) -RTMAX(JJ) )/(VQMAX(JJ+l) -VQ 
SLPMN  ( J  J )  -  ( RTMT.N  ( J  J+l )  -  RTMIN  (  J  J ) )  /  ( VQMIN  ( J  J +1 )  -  VQ 
RYINT(JJ)  -  RTMAX(JJ)  -  SLPMX(JJ )*VQMAX( JJ ) 
YMINT(JJ)  -  RTMIN(JJ)  -  SLPMN(JJ )*VQMIN(JJ ) 

15  CONTINUE 
C 
C 

C . FTZ  %  APPROACH  FACTOR. 

C 

FAPPCT=APPPCT* . 01 

n 

c 

C . INITIALIZE  CONSTANT  FOR  USE  IN  FTX.FTZ  CALCS. 

C . THESE  ARE  SMALL  PERTERBATION  LIMITING,  MAYBE 

C 

ZRT=  - ZWT*WB  -  G*COS (THETR) 

XRT  =  G*SIN  (THE!VIC*D2R) 

C 

C 

C . PEDAL  TO  YAW  ACCEL  SENSITIVITY  FACTOR 

C . SIDESLIP  LIMITATION  ENVELOPE  FACTOR 

C 

XNDPT  =  XKDP*(YVT*ZNRT  +  XNV  ) 

SLPFACT  =  - 1 . 0/XKDP 
C 
C 

C -  ICS  -  3  FILTER  COEFFICIENTS 

C 

C . PITCH  AXIS 

AAP ( 1 ) =0 . 0 
AAP (2 )“- ZMQD 
BBP ( 1 ) *-XMTHETO 
BBP(2)=-ZMQT 
BBP(3)-1.0 

C  CALL  FACT ( 2 , DT2 , AAP . BUFFP) ! COMMENTED  OUT  6/19/87  CLH 

C . ROLL  AXIS 

AAR( 1 )=0 . 0 
AAR(2)  — ZLPD 
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on  noon  on  noon  noon  non 


BBR(1)=-XLPHI0 
BBR(2)=-ZLPT 
BBR( 3 ) =1 . 0 

C  CALL  FACT ( 2, DT2 , AAR, BUFFR) ! COMMENTED  OUT  6/19/87  GLH 

C 

C 

COLLECTIVE  (ENGINE)  FILTER  COEFFICIENTS. 

AND  INITIAL  FILTER  OUTPUT 

C0LF1=EXP ( - DT2 /TAUCOL) 

C0LF2=GC0L* (1.0- C0LF1 ) 

COLOZ=GCOL*COLOP 


100  PERCENT  TORQUE 

QRAFCT- 1 00 . 0/ ( COLMAXT - CO LM I NT ) 


MULTIPIER  INSTEAD  OF  DIVISOR 

01687=1.0/1687.78 
INITIAL  PITCH  ATTITUDE 

THETIC  =  (  XUT*UB/G  )  *  R2D  +  THETOFF 
THETR  =  THETIC  *  D2R 


EQUATE  GAMH  AND  PS I. 

GAMHIC  =  PSIIC 

CALC.  INITIAL  PILOT  CONTROL  VALUES  FOR  ZEROING  IN  OP. 
IF  ICOZERO  =  1,  OTHERWISE  USE  ACTUAL  VALUES 
ROLLOIC  -  0. 

PITCHIC  =  0. 

YAWOIC  =  0. 

IF  (  ICOZERO  . EQ.  0  )  GOTO  90 
ROLLOIC  =  ROLLOP 
PITCHIC=  PITCHOP 
YAWOIC  =  YAWOP 
90  CONTINUE 
C 
C 

C - RESET  LOADER  DRIVES  AFTER  USING  MAG  BRAKE. 

C 

TRIM1C  =  ROLLOIC 
TRIM2C  =  PITCHIC 
TRIM3C  =  YAWOIC 
C 
C 

C . MAG  BRAKE  STATUS  EQUALS  MOMENTARY  SWITCH  POSIIiON  IN 

C 

IMB  =  IMBCP  +  IMBC  ! this  statement  was  IMB= IMBCP- IMBC 
C  failed  on  compile.  GLH  6/21/8 1 

C 
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c 

c 

C .  I.  C.  VALUE  OF  SGVOL. 

C 

TINC  =  TINCIC 
SGVOL=SGVOLIC 
GO  TO  101 

100  CONTINUE 
C 

C***************************  ******************************* 
C*****************  OPERATE  SECTION  ***************** 
C ********************************************************** 

c 

C . OPERATE  VALUE  OF  SOUND  GENERATOR  VOLUME 

C 

TINC  -  TINCOP 
SGVOL=SGVOLOP 

101  CONTINUE 
C 

C 

C - CONVERT  LONGITUDINAL  BODY  VELOCITY  TO  KNOTS. 

C 

UBKTS  =  UB*FPS2KOS 


C 

C 

C 

C .  COLLECTIVE  INPUT  . 

C . 

c 

c 

C . COLLECTIVE  TRIM 

C . SLOPE  AND  INTERCEPT  ARE  FUNCTION  OF  AIRSPEED 


C 

C 


IF( 

UBKTS 

. LE .  0.0 

) 

GO 

TO 

240 

IF( 

UBKTS 

. LE.  40.0 

) 

GO 

TO 

250 

IF( 

UBKTS 

.LE.  90.0 

I 

GO 

TO 

260 

I F  ( 
GO 

UBKTS 
TO  280 

.LE. 140.0 

) 

GO 

TO 

2  70 

C 

C .  HOVER 

240  CONTINUE 

SLP  *=  SLP 1 
YINT  -  YINTl 
GO  TO  290 

C 

C .  0  TO  40  KNO  ■  ^ 

250  CONTINUE 

SLP  -  SLP 2 
YINT  -  YINT2 
GO  TO  290 

C 

C--- . -  40  TO  90  KNOTS 

260  CONTINUE 

SLP  -  SLP 3 
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noon  on 


YINT  -  YINT3 
GO  TO  290 
C 

C .  90  TO  140  KNOTS 

270  CONTINUE 

SLP  -  SLP4 
YINT  -  YINT4 
GO  TO  290 

.  ABOVE  140  KNOTS 

280  CONTINUE 

SLP  =  SLP5 
YINT  =  YINT5 


C 

C. 

C 

C 


C 

C 

C 

C 

C 

C 

C. 

C 

c 


- COLLECTIVE  TRIM,  O(DOWN)  TO  10(UP) 

290  CONTINUE 

COLTRM  «  (YINT  +  SLP*UBKTS)*0. 1 

..RATE  OF  DESCENT  LIMIT. 

IF(UBKTS  .GE.  70.0)G0  TO  300 

RODLIM=( ROD INTI  +  RODSLP*UBKTS)*0 . 1 
GO  TO  305 

300  CONTINUE 

RODLIM=(RODINT2  -  R0DSLP*UBKTS)*0 . 1 
305  CONTINUE 

..AUTOMATICALLY  TRIM  IN  I.  C.  E.G.  FOR  DYNAMIC  CHECKS. 


I F ( ( IMODE  .LT.  0)  .AND.  (LTRIM  .NE.  0) ) C0L0P=C0LTRM 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


FILTER  COLLECTIVE  INPUT  TO  SIMULATE 
ENGINE  RESPONSE 

COLOZ  =  COLFL*COLOZ  +  COLF2*COLOP 

CLIMB/DIVE  COMMAND  (PILOT  -  TRIM) 

EROM4  =  COLOZ  -  COLTRM 

MAX.  RATES  OF  CLIMB  AND  DESCENT  LIMITATIONS. 
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n  n 


IF (UBKTS  .GT.  70.0)  GO  TO  310 

ROCLIM  =  0 . 1* (XINT1 (ICON)  +  RSLP1(IC0N)*UBKTS) 
GO  TO  320 
310  CONTINUE 

ROCLIM  -  0. l*(XINT2(ICON)  +  RSLP2(ICON)*UBKTS) 

320  CONTINUE 

IF( EROM4  .GT.  ROCLIM)  EROM4  -  ROCLIM 
I F ( EROM4  .LT.  RODLIM)  EROM4=RODLIM 
C 
C 

C . ENGINE  TORQUE  FOR  INSTRUMENT 

C 

LIMRPM  -  0 

QRAPCT  -  QRAFCT* ( COLOZ  -  COLMINT)  +  PCTBIAS 
1 F (  QRAPCT. GE. 98. )  LIMRPM-1 
C 

C . - . . . 

C-- .  STICK  AND  PEDAL  INPUTS  . - . 

C 

EROM1  =  ROLLOP  -  ROLLOIC 
EROM2  =  PITCHOP  -  PITCillC 
EROM3  -  YAWOP  -  YAWO I C 
C 


. GAIN  PILOT  COMMANDS 

C 

ROLLOZ  =  OOOG1*EROM1 
PITCHOZ  -  OOOGZ^i- ROMP 
YAWO  -  000G3  FROM 3 
COLO  -  000G4* KR0M4  ¥  000B4 
C 
C 
C 

C . DEADBAND  1  NTU  S  DM  PT  I.OT/AUTOPATH 

C 

CALI.  DEAD  (  RDBO  )  !  COMMENTED  FOR  DEBUG  SUSP 

CALL  DEAD (  PITCH'....,  PDBO  ) 

CALL  DEAD(  YAW  :  '"DBO  ) 

C  CALL  DEAD(  C01.O,  i.DHO  > 

C 

C 

C - -LIMIT  PI  LOT/ AUTOPATH  INPUTS 

C 


I F  ( 

ROLLOZ 

.  LT. 

-ROIJLAX 

) 

ROLLOZ  » 

-  R  01. MAX 

I F  ( 

ROLLOZ 

.  GT . 

ROLMAX 

) 

ROLLOZ  - 

R01MAX 

I  F( 

PITCHOZ 

.  LT . 

PITMAX 

I 

PITCHOZ 

P  I  TMAX 

1  F( 

PITCHOZ 

.  GT . 

P I TMAX 

) 

LIT'  HOZ 

P I  TMAX 

1  F( 

YAWO 

.  LT. 

YAWMA X 

YAWO 

- YAWMAX 

IF( 

YAWO 

.01 . 

,’AVMAX 

A  WO 

YAWMAX 

I  F( 

COLO 

.  LT. 

(.  •  CM  I  N 

) 

Cfil.O 

CO  I. OM  IN- 

IFf 

COI.O 

.  GT . 

C,  :‘1AX 

) 

COLO 

CO  LOMAX 

c 


C- . 

C- .  GAIN  SCEDULES  . 

C 

C 

C . DIRECTIONAL  GAINS,  WEATHER  VANE  EFFECT 

C 

IF(VEQ  .GT.  30.0)  GO  TO  350 
XNVO  “0.0 
ZNPO  =0.0 
XNPHIO  =0.0 
GO  TO  370 
350  CONTINUE 

IF(VEQ  .GT.  50.0)  GO  TO  360 

XNVO  =  XNV*VEQ*C1687  -  0.02365 
ZNPO  =  0 . 01908*VEQ  -  0.57235 

XNPHIO=  -ZNPO*ZNRT 
GO  TO  370 
360  CONTINUE 

IF(UB  .LT.  0.00006)  UB-0.001 
XNVO  =  XNV/UB 

ZNPO  =  G/UB 

XNPHIO  =-ZNPO*ZNRT 
370  CONTINUE 
C 
C 

C . VEHICLE  SENSITIVITIES  DUE  TO  TURBULENCE 

C 

CC  CALL  VBARG(VEQ.VEQRT) !  COMMENTED  BY  GLH  6/16/87 

C 

CC  ZLVT  =  FIXGN1 (ZLVMT)  !  COMMENTED  BY  GLH  6/16/87 

CC  ZMUT  =  FIXGN1 (ZMUMT)  !  COMMENTED  BY  GLH  6/16/87 

CC  ZMWT  =  FIXGNl (ZMWMT)  !  COMMENTED  BY  GLH  6/16/87 

CC  ZNVT  =  FIXGNl (ZNVMT)  !  COMMENTED  BY  GLH  6/16/87 

CC  ZUT  »  F I XGN 1 ( ZUTMT )  !  COMMENTED  BY  GLH  6/16/87 

CC  ZWTT  =  FIXGNl (ZWTMT)  !  COMMENTED  BY  GLH  6/16/87 

C 
C 

C . SIDESLIP  LIMIT 

I F ( V EQ  .GT.  VEQPT (ICON) )  GO  TO  420 

BETMAX  =  ESLP1(IC0N)*VEQ  +  EINTl(ICON) 

GO  TO  430 
420  CONTINUE 

BETMAX  =  ESLP2 ( ICON)*VEQ  +  EINT2(ICON) 

430  CONTINUE 
C 

C . HUD  VARIABLE 

C 

BETATMP  =  BETA/BETMAX 
BETAHUD  =  BETATMP*BETAFG 

I F(  VEQ  . LT .  30.  ) BETAHUD=BETAHUD*VEQ* . 03333 
LIMBET  =  0 

I F (  ABS( BETATMP)  . GE .  .95  )  LIMBET- 1 
IF(  VEQ  .LT.  30.  )  LIMBET-0 
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c 


o 

C - -MAX  EFFECTIVE  l'EDAL  DEFLECTION 

C 

PF.DMAX  -  -  B  ETM  A  X  *  S  LP  FACT*D  2  R 
T  F  ( YAV.'O  .err.  t' ED  MAX)  YAWO  -  PEDMAX 
I F ( YAWO  .LT.  -PF.DMAX)  YAWO  -  -PEDMAX 
C 

C - CONTROL  SYSTEM  TYPE 

C 

go  to  (  )0o,  v.n.sso)  ics 

c 

C-  -  - . -  -  -  - - 

C . -  -  PURE  RATE  COMMAND  SYSTEM : ICS-1 

C 

c 

500  CONTINUE 
C 

ROLLQ  ROLL. OX 

PITCliO  P I  TCI  [OX 

XLPHJO  •  X  LPH.il 
XMTHETO  X 1  .PM  1 0 

ZMOT  V.y.r.\ 

XMSi".,r  XML”  • 

XI.DAT  XLDAi 


GO  TO  -  ■ 

C 

C 

C .  -  -  -  - . 

C - -  Air  r  •  '  FT.  HOLD.  ICS--? 

C 

C 


XMDET  -  0.13 
GO  TO  600 


C 

C . 

C .  RATE  COMM.  /  ATT.  HOLD.  ICS-3 

C 

C 

580  CONTINUE 


C 

C 

C 

C 


C 

C 

C 

C 


C 


- PITCH  AXIS. 

CALL  UPDATE (PITCHOZ, 2, IMODE, BUFFP , XXP) ! COMMENTED  OUT 

PITCHO—BBP ( 1 ) *XXP ( 1 )  BBP(2)*XXP(2)  + 

BBP(3)*( PITCHOZ  -  AAP(1)*XXP(1)  -  AAP(2)*XXP(2) 

- ROLL  AXIS. 

CALL  UPDATE (ROLLOZ, 2, IMODE ,BUFFR,XXR) ! COMMENTED  OUT  6 

ROLLO  =BBR(1)*XXR(1)  +  BBR(2)*XXR(2)  + 

BBR( 3)* (ROLLOZ  -  AAR(1)*XXR(1)  -  AAR(2)*XXR(2) ) 

XLPHIO  -  XLPHI3 
XMTHETO  =  XLPHIO 
ZMQT  -  ZMQ1 
ZLPT  -  ZLP1 
XLDAT  -  XLDA3 
XMDET  -  XMDE3 
600  CONTINUE 


9999  RETURN 
END 
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SMART . FOR 


C**********  SOURCE  FILE  NAME  -  SSMARTM 
C 
C 
C 

C****************************************************** 
c*********  HAC3  SSMARTM  ***** 

C****************************************************** 


C 

C 

C 

C  TITLE  SMART  (CDC  7600  VERSION)  -  UPDATED  9/17/84 


C23456 7890123456 78901234567890123456789012345678901234567 
C  1  2  3  4  5  6 

C 
C 

SUBROUTINE  SMART 

C 

C 

C 

f;  *  *************************************************  * ****** 

C  SUBROUTINE  ABSTRACT  &  HIERARCHY 

C ******************************************************** 

c 

C  (  CDC  7600  VERSION  ) 

G 

C  SMART  IS  A  FAST  LOOP  ROUTINE  WHICH 

C  SOLVES  THE  STANDARD  KINEMATICAL  EQUATIONS 

C  AND  PROVIDES  A  STANDARD  ATMOSPHERE  MODEL. 

C  IT  IS  CALLED  BY  FASTP  AND  IN  TURN  CALLS  ARDG 

C 
C 
C 

(]-k'k'k'k'k  ■k'k'k'k  k  A-  k'k  k'k'k'k k'k'k'kA  Ar*  k'k'k'k'k'k'k'k'k'k'k-k'kk'k'k  k'k'k'k-k'k  k'k'k'k  k  k  k  kkk  k 

C  CREATION  &  MODIFICATION  LOG 

(^*  *****************************************************  *** 

0 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c; 
c 
c 
c 
c 


R.  E.  MCFARIAND  -CSC-  MARCH  19/4 

11/15/84  MODIFIED  TO  MEET  BASIC  NOTE  A 123 

08/13/84  B . CHUNG  MODS  TO  MAKE  PILOT  EYEPO ! NT  DIKE 

FROM  MOTION  POINT  BY  7.1 'E  (  II  DIS 
FROM  PILOT  MOTION  POINT  To  PILOT 
POINT) 

09/17/83  P. RANDALL  SYRE  REFORMATTED 


C 
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C  02/28/85  SCB  REMOVED  SMART  TIMESAVER  FOR  CDC 

C 

C  12/29/85  SCB  MODS  TO  REMOVE  ANY  COMBO  OF  DEGR 

C  FREEDOM  WITH  FLAGS  :  I PON  TO  IVD 

r, 

C  NOV  1986  SET  UP  FOR  HAC  -  III  SIMULATION: 

C  REMOVAL  OF  CALCULATIONS  DONE  IN  C 

C 

C  JUN  1987  Replaced  COMMON,  EQUIVALENCE,  AND 

C  STATEMENTS  with  INCLUDE  HAC. INC. 

C 

C  01/19/1988  MCL  FIXED  NEGATIVE  ALTITUDE. 

C 

C 

C 

C 

C****************************************************** 

c 

INCLUDE  ' [HELHAC . F0R]HAC1 . INC/LIST' 

INCLUDE  ' [HELHAC . FOR]HAC2 . INC/LIST' 

INCLUDE  ' [HELL  iC. F0RJHAC3 . INC/LIST' 

INCLUDE  ' [HELHAC. FOR]FLTDATA. INC/LIST' 

C 

c****************************************************** 
c  EXECUTAB  L  E  CODE 

C****************************************************** 

C 

c 

c  DELT  -  DT2 

C 
C 
C 

C*****TOTAL  AIRCRAFT  FORCE  COMPONENTS 

C 

C  FTX-FAX+FEX+FGX 

C  FTY-FAY+FEY+FGY 

C  FTZ-FAZ+FEZ+FGZ 

C 

C...THE  ABOVE  CALCULATIONS  ARE  DONE  IN  CONTR2 . 

C 

C 

C 

C 

C*****TOTAL  AIRCRAFT  MOMENT  COMPONENTS 
C 

C  TTL-TAL+TEL+TGL 

C  TTM-TAM+TEM+TGM 

C  TTN-TAN+TEN+TGN 

C 
C 

C*****TOTAL  AIRCRAFT  FORCE  COMPONENTS  IN  EARTH  FRAME 
C 

FN-T 1 1 * FTX+T 2 1*FTY+T3 1*FTZ 
FE-T12*FTX+T22*FTY+T32*FTZ 
FD-T13*FTX+T23*FTY+T33*FTZ 
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c 

c 

c 

C*****DOWNWARD  ACCELERATION 
C 

TEMP-1. /XMASS 
VDD-(FD+FG)*TEMP 
C 
C 

C*****DI STANCE  FROM  EARTH'S  CENTER  TO  AIRCRAFT 
C 

RTV-ALT+RE 

C 

C 

IF(IFLAT)  420,415,420 
C 
C 

C*****AIRCRAFT  ACCELERATION  COMPONENTS  FROM  ROTATING 
c  EARTH  FRAME 

C 

415  CONTINUE 

RTVINV-1 . 0/RTV 
TEMP1-RTVINV 

VND-FN*TEMP+ ( VN*VD - VE**2*TLAT ) *TEMP1 
VED=FE*TEMP+ (VE*VD+VN*VE*TLAT)*TEMP1 
VDD-- (VE**2+VN**2)*TEMP1+VDD 
RCLAT-RTV*CLAT 
ROUNDV- - OMEG*RCLAT 
CO  TO  430 
C 
C 

C*****AIRCRAFT  ACCELERATION  COMPONENT  FROM  FIXED, 
cFLAT  EARTH  FRAME 
C 

420  VND-FN*TEMP 
VED-FE*TEMP 
TEMP1-0 . 

ROUNDV-O . 

RCLAT=RE 
REINV-1 ./RE 
RTVINV-REINV 
C 

c 

430  IF(IMODE)  440,1000,450 
C 
C 

C ******************************************************** 

C  INITIAL  CONDITIONS 

c  (  I.  C  .) 

C  **************  **************************  5^  **********5<^** 

C 

c 

C 

440  DTIME-0 . 

DELTI-0 . 
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DELTH-0 . 
DTINV-O. 
GO  TO  465 


C 

C 

C 

C******************************************************** 
C  OPERATfi(OP) 

C******************************************************'** 

c 

c 

c 

450  DELTI-0 . 5*DELT 
C 
C 

C***** ADDED  FEB. 77  BY  R . E . MCFARLAND 

C*****IFREEZ-1  FIXES  TRANSLATIONAL  AS  WELL  AS  ROTATIONAL 
c  MOTION 

C*****(I.E.  IFFCI  IS  IMMATERIAL  IF  IFREEZ-1) 

C 

IF(IFREEZ.EQ.l)  DELTI-O. 

DTINV— 1 . O/DELT 
IF(IFFCI)  460,460,455 
455  DELTH-O. 

GO  TO  462 
C 

460  DELTH-DELTI 
462  DTIME-DTIME+DELT 
465  TIME-DTIME 

C 

C 

C 

0****************************************************^  k-k 

C*******  AIRCRAFT  LINEAR  ACCELERATIONS  ***** 

C******************************************************* 

C 

c 

c 

c 

C . 

C .  ARTI  ARMCOP  MODIFICATIONS 

C . 

c 

C*****INTEGRATE  THE  EARTH  FRAME  ACCELERATION  COMPONENTS 
c  INTO 

C*****EARTH  FRAME  VELOCITIES  USING  AN  ADAMS'  SECOND-ORDER 

c*****predictor  formula. 

C. . .Added  to  freeze  airspeed  when  needed.  MCL  01/25/88 
AIR_DELTH  -  DELTH 

IF  (AIRSPEED_HOLD  .EQ.  .TRUE.)  THEN  AIR_DELTH  =  0.0 
c  VN-VN+DELTH* ( 3 . 0*VND-VNDP) 

C  VE-VE+DELTH*(3.0*VED-VEDP) 

C  VD-VD+DELTH* ( 3 . 0*VDD - VDDP ) 

C . 

VN-VN+AIR_DELTH* ( 3 . 0*VND-VNDP) 
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VNDP-VND 

VE-VE+AIR_DELTH*(3 , 0*VED-VEDP) 

VEDP-VED 

VD-VD+AIR_DELTH*(3 . 0*VDD-VDDP) 

VDDP-VDD  ' 

C 

C 

C*****CREATE  AIRCRAFT  VELOCITIES  IN  LATITUDE  AND  LONGITUDE 
c  AXES. 

C 

VEE-VE+ROUNDV 

XLATD-VN*RTVINV 

XLOND-VEE/RCLAT 

C 

C 

C*****INTEGRATE  THE  VELOCITIES  IN  THE  LAT/LONG  AXES  INTO 
C*****LATITUDE  AND  LONGITUDE  USING  A  TRAPEZOIDAL  CORRECTOR 
C*****_  ORMULA . 

C 

XLON-XLON+DELTH*(XLOND+XLONDP) 

XLONDP-XLOND 

XLAT-XLAT+DELTH*(XLATD+XLATDP) 

XLATDP-XLATD 

ALT_DELTH  -  DELTH 

IF  (ALT_HOLD  .EQ.  . TRUE . ) ALT_DELTH  -  0.0 
c 

ALT-ALT - ALT_DELTH* ( VD+VDP ) 

IF  (ALT  . LT .  0.0)  ALT  -  0.0 
C 

VDP-VD 

C 

C*****AIRCRAFT  POSITION  RELATIVE  TO  RUNWAY 
C 

ALTD=-VD 

HCG-ALT-HR 

DNR-RR* ( XLAT - XLATR ) 

DER=RR*CLATR* (XLON - XLONR) 

C 

C 

Q**1c********ic***********'k'k'k'k'k'kj(:'k'k'k‘k'tc‘k'k'k')('k*  ***********•&:* 

c 

c 

C 

c 

c 

c . 

c 

c... THESE  CALCULATIONS  ARE  DONE  IN  CONTR2 . 

C 

C 

C 

C  PBD-I PON* ( (XMC ( I ) *RB+XMC ( 2 ) *PB ) *QB+XMC ( 3 ) *TTL+XMC ( U ) 
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C  1  *TTN  +  XMCC1*QB  +  XMCC5*RB  -  XMCC6*PB) 

C  QBD-IQON* ( XMC ( 5 ) *RB*PB+XMC ( 6 ) * (RB**2 - PB**2 ) +XMC ( 7 ) 

C  1  *TTM  -  XMCC2*RB  +  XMCC3*PB) 

C  RBD-IRON* ( (XMC ( 8 ) *PB+XMC ( 9 ) *RB) *QB+XMC (4 ) 

1  *TTL+XMC(10)*TTN 

Cl  +  XMCC4*QB  +  XMCC6*RB  -  XMCC7*PB) 

C 

C 

C*****INTEGRATE  THE  BODY  AXES  ANGULAR  ACCELERATIONS  INTO 
c*****BODY 

C*****AXES  ANGULAR  VELOCITIES  USING  AN  ADAMS'  SECOND-ORDER 
C*****PREDICTOR  FORMULA. 

C 

PB“PB+DELTI*(3 . 0*PBD-PBDP) 

PBDP=PBD 

QB=QB+DELTI*(3 . 0*QBD-QBDP) 

QBDP=QBD 

RB=RB+DELTI*( 3 . 0*RBD-RBDP) 

RBDP=RBD 

C 

C 

C*****AIRCRAFT  TOTAL  ROTATIONAL  RATE,  EARTH  FRAME 
C 

PT=PB- PLB 
QT-QB-QLB 
RT=RB-RLB 

C 

C 

C*****AIRCRAFT  TOTAL  ROTATIONAL  RATES,  BODY  FRAME 
C 

C  PBWN=PB+PTURB 

C  QBWN=QB+QTURB 

C  RBWN=RB+RTURB 

C 

C...THE  ABOVE  CALCULATIONS  ARE  COMMENTED  OUT  BECAUSE 
c  TURBULENCE  FACTORS 
C. . .  APPEAR  IN  CONTR2 . 

C 

C 

PBWN=PB 

QBWN-QB 

RBWN-RB 

C 

C 

C*****AIRCRAFT  ROTATIONAL  RATES,  EARTH  FRAME 
C 

THED«QT*CPHI -RT*SPHI 
PSID- (QT*S  PH I+RT*CPH I ) /CTHT 
PHID-PT+PSID*STHT 
C 
C 

C*****INTEGRATE  THE  EARTH  FRAME  ANGULAR  VELOCTIES  INTO 
c  EULER 

C*****ANGLES  USING  A  TRAPEZOIDAL  CORRECTOR  FORMULA . 

C 
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C. . .Added  to  hold  heading.  MCL  01/26/1988 
HEADING_DELTI  =  DELTI 

IF  (HEADING_HOLD  .EQ.  .TRUE.)  HEADING_DELTI  =0.0 

c  .  .  . 

PSIR_P  ~  PSIR 

THETR=THETR+DELTI*(THED+THEDP) 

PSIR=PSIR+HEADING_DELTI*(PSID+PSIDP) 

PHIR-PHIR+DELTI*(PHID+PHIDP) 

THEDP-THED 

PSIDP-PSID 

PHIDP-PHID 

C 

C 

C*****NEW  SINE  &  COSINE  OF  EULER  ANGLES 
C 

SPHI=SIN(PHIR) 

C PHI-COS (PHIR) 

SPSI-SIN(PSIR) 

CPSI-COS(PSIR) 

STHT=SIN(THETR) 

CTHT-COS ( THETR ) 

C 

C 

C*****NEW  TRIGONOMETRIC  MULTIPLIERS 
C 

T11=CTHT*CPSI 

T21=SPHI*STHT*CPS1-CPHI*SPSI 

T31-CPHI*STHT*CPSI+SPHI*SPSI 

T12-CTHT*SPSI 

T22=SPHI*STHT*SPSI+CPHI*CPSI 

T32»CPHI*STHT*SPSI-SPHI*CPSI 

T13--STHT 

T23=SPHI*CTHT 

T33-CPHI*CTHT 

C 

C*********************  y.  A-******************************** 

C 

C 

c 

C*****PIL0T  EYE POINT  POSITION  RELATIVE  TO  RUNWAY  IN  EARTH 
c  AXES 

C 

DNPR=DNR+Tll*XP+T21*YP+T3l*(ZP-ZPE) 

DEPR=DERfT12*XP+T22*YP+T32*(ZP-ZPE) 

C 

XPR=DNPR*CTHETR4DEPR*STHETR 
YPR=  -  DNPR*STHETR  ( DEPR*CTHF.TR 
HPR=HCG-T13*XP-T23*YP-T33*(ZP-ZPE) 

c  WRITE(9, 1999) DNR , DER 
c  WRITE(9,2000)XPR.YPR 

c  1999  FORMAT (IX, 'DNR  =  '.F18.4,'  DER  =  ' , F 1 8 . 4 ) 
c  2000  FORMAT  ( 1 X  ,  '  X  PR  ■=  '.FI  8. 4,'  YPR  =  ’.F18.4) 

C 

C 
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c*****aircraft  c.g.  relative  to  runway  in  runway  axes 

c 

XCG=DNR*CTHETR+DER*STHETR 

YCG--DNR*STHETR+DER*CTHETR 

C 

c 

C*****TURBULENCE  VELOCITY  COMPONENTS 
C 

C*****IF  IETURB.EQ.l  THE  RANDOM  TURBULENCE  IS  ALREADY 
c  GENERATED  IN  THE 

C*****EARTH  AXES  AS  VNTURB ,  VETURB,  VDTURB .  OTHERWISE, 

c  THESE  EQUATIONS 

C*****EXPECT  UTURB ,  VTURB  AND  WTURB . 

I F ( I ETURB . EQ . 0 )  CO  TO  500 
UTURB=T11*VNTURB+T12*VETURB  fT13*VDTURB 
VTURB-T2 1*VNTURB+T2  2*VETURB  fT2  3*VDTURB 
WTURB“T31*VNTURB+T32*VETURB  fT3 3* VDTURB 
GO  TO  520 
C 

500  VNTURB— I  i  i  *  u  J’UR  B+T2 1  *VTURB  +T 3 1  *WTUR  B 
VETURB=T12*UTURB+T22*VTURB+T32*WTURB 
VDTURB=T13*UTURB+T23*VTURB+T33*WTURB 
C 
C 

520  CONTINUE 
C 
C 
C 

C*****TOTAL  WIND  VELOCITIES 
C 

C  VTWN=VNWf VNTURB 

C  VTWE-VEW+VETURB 

C  VTWD-VDW+ VDTURB 

C 

C... ABOVE  CALCULATIONS  COMMENTED  OUT  BECAUSE  TURBULENCE 
c  EFFECTS  ARE 

C... TAKEN  INTO  ACCOUNT  IN  CONTR2 . 

VTWN=VNW 

VTWE-VEW 

VTWD-VDW 

C 

C 

c 

C*****AIRCRAFT  RELATIVE  VELOCITIES 
C 

VNR-VN-VTWN 
VER-VEE-VTWE 
VDR-VD- VTWD 
C 
C 

C*****AIRCRAFT  VELOCITY  (BODY  FRAME) 

C 

UB=TI I *VNR  tTI ?*VKR-fTl 3*VDR 
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VB-T21*VNR+T22*VER+T23*VDR 

WB-T31*VNR+T32*VER+T33*VDR 

C 

C*****ANGLE  OF  ATTACK  W/  SINE  AND  COSINE 
C 

IF(ABS(UB) .LT. 0.00001)  UB-SIGN(0 . 00001 ,UB) 
ALFAR-ATAN2 (WB , UB) 

S ALPH- S I N ( ALFAR ) 

CALPH-COS ( ALFAR) 

C 

C 

C*****S I DESLIP  ANGLE  W/SINE  AND  COSINE 
C 

DUM2-UB**2+WB**2 
DUM-SQRT ( DUM2 ) 

DUM 1— S IGN ( DUM , UB ) 

BETAR-ATAN2 ( VB , DUM1 ) 

SBETA-SIN(BETAR) 

CBETA-COS (BETAR) 

C 

C 

C*****AIRCRAFT  VELOCITY  WITH  RESPECT  TO  WIND 
C 

VRW2-DUM2+VB**2 
VRW-SQRT( VRW2 ) 

C 

C 

C*****AIRCRAFT  ACCELERATION  (BODY  AXIS) 

C*****WIND  ACCELERATION  INCLUDES  ONLY  MEAN  WIND 
C 

ATWN- ( VNW - VNWP ) *DT I NV 
ATWE-(VEW- VEWP) *DTINV 
ATWD-(VDW-VDWP)*DTINV 
VNWP=VNW 
VEWI =VEW 
VDWP-VDW 
C 

RAN-VND- ATWN 
RAE=VED-ATWE 
RAD-VDD - ATWD 

UBD-RT*VB-QT*WB+Tll*RAN+T12*RAEfT13*RAD 
VBD=PT*WB -RT*UB+T2 1*RAN+T22*RAE+T23*RAD 
WBD=QT*UB-PT*VB+T31*RAN+T32*RAE+T33*RAD 
C 

C 

IF(IMODE)  632,636,636 
C 
C 
C 

C ***************************************** ************** 
C  INITIAL  CONDITIONS 

c  (  I.  C  .) 

C********************************************** ********* 

c 
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c 

c 

632  IF(ITOMTR)  636,636,634 
634  ALFD-0. 

BETD=0 . 

GO  TO  640 
C 
C 
C 

C  OPERATE(OP) 

C******************************************************* 

c 

c 

c 

636  CONTINUE 

ALFD=(UB*WBD-WB*UBD) /DUM2 

BETD~(DUM2*VBD-(UB*UBD+WB*WBD)*VB)/(DUM1*VRW2) 

640  CONTINUE 

C 

C 

C*****AIRCRAFT  ACCELERATION,  BODY  FRAME 
C 

AX=FTX*TEMP 
AY=FTY*TEMP 
AZ=FTZ*TEMP 
ANZ-- (AZ/G) 

C 

C 

C***** PI LOT  ACCERATION,  BODY  FRAME 
C 

AXP=AX- (RB**2+QB**2 ) *XP+ ( PB*QB - RBD) *YP+ ( PB*RB fQBD) *ZP 
AYP=AY+ ( PB*QB+RBD) *XP- (RB**2+PB**2 ) *YP+(QB*RB - PBD ' *Z P 
AZP=AZ+(PB*RB-QBD)*XP+(QB*RB+PBD)*YP-(QB**2+PB**2)*ZP 
C 

C*****ALPUA ,  BETA,  &  EULER  ANGLES  IN  DEGREES 
C 

THET=THETR*R2D 

PHI=PHIR*R2D 

PHIRDM=PHI 

PSI=PSIR*R2D 

ALFA-ALFAR*R2D 

BETA=BETAR*R2D 

C 

C 

C*****EQUI VALENT  AIRSPEED 
C 

VEQ=TEMA*VRW 

C 

C***** INSTANTANEOUS  ROTATIONAL  RATES  (L- FRAME) 

C 

PL=VE*TEMP1 

QL--VN*TEMP1 

R1>=-PL*TLAT 

C  Turn_rate  ADDED  7/21/88  GUI.  COMPUTES  TURN  RATE  IN 
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c  RADIANS/SEC. 

IF(DELTI  .NE.  0.)  TURN_RATE  =  (PSIR  -  PSIR_P) /DELTI 
C 

C*****INSTANTANEOUS  ROTATIONAL  RATES  (BODY  FRAME) 

C 

PLB-T1 1*PL+T 1 2*QL+T1 3*RL 
QLB-T  2 1 *  P L+T  2  2  *QL+T 2  3 *RL 
RLB-T  3 1*PL+T3  2*QL+T3 3*RL 
C 
C 

C*****AIRCRAFT  TOTAL  VELOCITY  &  GROUND  SPEED 
C 

PAD-VN  **  2  +VEE**2 
VT-SQRT ( PAD+VD**2 ) 

VG-SQRT(PAD) 

C 

C 

c*****flight  path  angles 

c 

IF(VT.EQ.O.O)  GO  TO  735 
GAMV=ATAN2(-VD,VC) 

I F ( PAD . EQ . 0 . 0 )  GO  TO  735 
GAMH=ATAN2 (VEE , VN) 

735  CONTINUE 
C 
C 

C*****ACCELERATION  DUE  TO  GRAVITY 
C 

FG=WAIT*(RE*RTVINV) **2 
G-FG*TEMP 


C 

C 

C*****LATITUDE  TRIGONOMERIC  MULTIPLIERS 
C 

SLATES  IN (XLAT) 

CLAT“COS (XLAT) 

TLAT=SLAT/CLAT 

C 

C 

C*****AIR  DENSITY  AND  SPEED  OF  SOUND 
C 

IF(ICOND)  804,804,806 
804  XX=ALT 

GO  TO  807 
C 

806  XX-HRHOZ 

807  CONTINUE 

C  CALL  ARDC62 (XX, SOUND, RHO) ! COMMENTED  OUT 

c  ARDC  6/19/87  CLH 

RHO=RHO/YCON 
SOUND=SOUND*SQRT (YCON) 

C 

C*****TEMPERATURES ,  PRESSURES,  AND  THEIR  RATIOS 
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c 

TR-1.+.2*XMACH**2 
IF(XMACH-XMl)  810,810,820 
810  PR“TR*TR*TR*SQRT ( TR) 

GO  TO  830 
C 

820  IF(XMACH)  825,825,828 
825  PR-1.0 

GO  TO  830 
C 

828  CONTINUE 

TEMPA=XMACH**2 
TEMP2-7 . -l./TEMPA 

PR=166 . 9*TEMPA/(TEMP2*TEMP2*SQRT(TEMP2) ) 

C 

830  IF(ALT-HLEV)  840,840,850 
840  TAMBR-1. -6 . 875E-6*ALT 
PAMBR=TAMBR**5 .256 
GO  TO  860 
C 

850  TAMBR-. 751895 

PAMBR= . 2234*EXP( -4 . 806E- 5*(ALT-HLEV) ) 

860  CONTINUE 

TAMB=DELAT+TAMBR*TEMPZ*. 5555555 
PAMB»PAMBR*PRESZ 
PTOT-=  PR*  PAMB 
TTOT-TR*TAMB 
QBARC-PTOT- PAMB 
C 
C 

C*****CALIBRATED  AIRSPEED 
C 

C*****MODI FY  RHO  AND  SOUND  BY  DELTA  TEMPERATURE  EFFECT 
YCON-TAMB/ ( TAMB - DELAT ) 

XMACH-VRW/SOUND 
RH02-0. 5*RH0 

TEMA-. 59249*SQRT(RHO/RHOZ) 

IF(VEQ-IO.O)  870,880,880 
870  VCAL-VEQ 
GO  TO  890 
C 

880  VCAL- . 59249*SOUNDZ*SQRT (5.0* 

1  ((QBARC/PRESZ+1.0)**. 2857-1 .0)) 

890  CONTINUE 
C 
C 

1000  CONTINUE 
C 
C 

QBAR=RH02*VRW2 

C 

c 

c 

RETURN 

END 
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FAM . FOR 


C  TITLE  FAM 

C 

C 

SUBROUTINE  FAM 
C 
C 
C 

C**************************************************************** 
C************  SUBROUTINE  ABSTRACT  AND  HIERARCHY  ************* 
(]********•*•  ■  ***************************************************** 

C 

c 

C  ROUTINE  PROVIDES  A  SIMPLE  HELICOPTER  INCLUDING 
C  AERO,  ENGINE,  AND  PART  OF  THE  EQUATIONS  OF  MOTION. 

C  IT  REQUIRES  A  MODIFIED  SMART. 

C 

C 

C**************************************************************** 
c************  CREATION  AND  MODIFICATION  LOG  ************* 

C**************************************************************** 

C 

C 

C  6/25/87  DERIVED  FROM  CONTR2 . FOR ,  GLH 

C**************************************************************** 
C*************  SIGNIFICANT  VARIABLES  ****************** 

C 

C 

C . . 

C--  INPUTS 
C- . 

c 

C  ICONFI  CRAFT  CONFIGURATION:  UH60,  AH1S  OR  LHX . 

C 

C 

C  APPPCT  APPROACH  PERCENT,  0-100 

C  PERCENT  C-  FULL  ENGINE  POWER  FOR  YELLOW  LIGHT 

C  REDTIME  TIME  AT  100  PERCENT  TORQUE  FOR  RED  LIGHT 
C 
C 

C-  -  - . 

C--  OUTPUTS 

C . 

C 

C  FZMAX  MAX  Z  FORCE  FOR  CURRENT  AIRSPEED 

C  FZMIN  MIN 

C  APPMAX  MAX  Z  FORCE  APPROACH  LIMIT  FOR  CURRENT  AIRSPEED 

C  APPMIN  MIN 

C  KYELLOW  Z  FORCE  APPROACH  LIMIT  REACHED  0  OR  1 

C  KRED  Z  FORCE  LIMIT  REACHED  0  OR  1 

C ***********************************************************  •!•**  -'  ** 

c 
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INCLUDE  ' [ HELHAC . FOR]HACI . INC/LIST' 

INCLUDE  ' [HELHAC. FOR ]HAC2. INC/LIST' 

C***************************************************************** 
C*****************  EXECUTABLE  CODE  ************************** 

C***************************************************************** 

c 

C . CALCULATE  PITCH  ANGLE  DUE  TO  VELOCITY 

C 

TMDUM= - XUT*U  B/G 
C 
C 

C - - - - 

C . -  TARGET  ROTATIONAL  ACCELS.  (RADS/S**2)  - 

C 

C 

PBD  -  ZLPT*PB  +  XLDAT*ROLLO  +  XLPHIO*PHIR 
+  ZLV  *VB  +  ZLVT  *VTURB  4  PBDR 
C 

QBD  =  ZMQT*QB  +  XMDET*PITCHO  4  XMTHETO*(THETR  4  TMDUM) 

4  ZMIJ  *UB  f  ZMUT  *UTURB  +  ZMWT*WTURB  4  QBDR 

C 

RBD  =  ZNRT*RB  *  XNDPT*YAWO  +  XNPHIO*PHIR 

4  XNVO*VB  I  ZNVT  *VTURB  4  ZNPO*PB  +  RBDR 

C .  . . . - . 

C .  TOTAL  TRANSLATIONAL  FORCES  ON  VEHICLE  . 

C 

C 

FTX  =  XMASS* (  XRT  4  XUT*(UB  +  UTURB)  )  +  FRX 

FTY  -  XMASS*(  YRT  +  YVT*(VB  +  VTURB)  )  +  FRY 

FTZ  -  XMASS* (  ZRT  +  ZWT*  WB  +  ZUT*UTURB  4  ZWTT*WTURB 
4  ZDCT*COLO  )  f  FRZ 


C 

C 

C 

C . . . 

c -  FTZ  LIMIT  CALCU1AT IONS  . 

C 

c 

C . -GET  APPROPRIATE  SLOPE  AND  INTERCEPT 

C . FOR  MIN /MAX  LOAD  FACTOR 

C 


DO  700  MM  - 1  ,  *> 

I F ( V  EQ  .CT.  VQMAX (MM  t 1 ) )  GO  TO  700 
SLPMAX-  SLPMX(MM) 

YINTMX= RYINT(MM) 

GO  TO  710 
700  CONTINUE 
710  CONTINUE 
C 


o  o 


C 

DO  740  JJ-1,5 

IF(VEQ  .GT.  VQMIN(JJ+1) )  GO  TO  740 
SLPMIN-SLPMN ( J J ) 

YINTMN-YMINT ( JJ ) 

GO  TO  750 
740  CONTINUE 
750  CONTINUE 
C 
C 

C . CALCULATE  MIN  /  MAX  FOR  FTZ 

C . (NOTE:  FZ  IS  POSITIVE  DOWN]  . . .JWB) 

C 

ZNMAX  -  YINTMX  +  SLPMAX*VEQ 
ZNMIN  -  YINTMN  +  SLPMIN*VEQ 
C 

FZMIN  -  -ZNMAX  *  WAIT 
FZMAX  -  -ZNMIN  *  WAIT 


C . CALCULATE  FTZ  APPROACH  LIMITS. 

C 

APPMIN-FZMIN  -  (FZMIN  -  WAIT)*FAPPCT 
APPMAX-FZMAX  +  (FZMAX  -  WAIT)*FAPPCT 
C 
C 
C 

C . 


C .  FTZ  LIMIT  APPLICATION  . 

C 

IF(  FTZ  .LT.  FZMIN  )  FTZ-FZMIN 
I F (  FTZ  .GT.  FZMAX  )  FTZ-FZMAX 
c  WRITE(6, 200) FZMIN, FZMAX 

c200  FORMAT (IX, 'FZMIN-' ,F14. 4, '  FZMAX-’ , F14 . 4) 


C 

LIMG  -  0 

IF(  (FTZ . LE . ( . 95*FZMIN) )  .OR.  (FTZ . GE . ( . 95*FZMAX) ) ) 
,  LIMG-1 

RETURN 
END 


94 


BEEPER. FOR 


C  TITLE  BEEPER 

C 

C 

SUBROUTINE  BEEPER 
C 
C 
C 

C******************************************************** 
C************  SUBROUTINE  ABSTRACT  AND  HIERARCHY  ***** 

C******************************************************** 

C 

c 

C  ROUTINE  PROVIDES  FOR  TRIM  BEEPER  AND  MAG  BRAKE. 

C  IT  REQUIRES  A  MODIFIED  SMART. 

C 

C 

C******************************************************** 
C************  CREATION  AND  MODIFICATION  LOG  ***** 

C**************************************  **************** -A--* 

c 

c 

C  6/25/87  DERIVED  FROM  CONTR2 . FOR,  GLH 

C************************ ******************************** 
c*************  SIGNIFICANT  VARIABLES  ********** 

C 
C 
C 

C  ROLLOP 
C  PITCHOP 
C  YAWOP 
C  COLOP 
C 

C  IMBC 
C  IRWD 
C  ILWD 
C  IANU 
C  I  AND 
C 

C  ICS 
C 
C 

C  MCS 
C  ICONFI 
C 
C 

C****************************************** ************* 

c 

INCLUDE  ' [HELHAC. FOR] HAC1. INC/LIST' 

INCLUDE  ' [HELHAC. FOR] HAC2. INC/LI ST' 


LATERAL  CYCLIC 

+  - 

6 

INCHES 

LONGITUDINAL  CYCLIC 

+  - 

6 

INCHES 

PEDAL 

+  - 

3.5 

INCHES 

COLLECTIVE 

0 

-  10 

INCHES 

MAG  BRAKE  MOMENTARY  FROM  CAB  0  OR  1 

TRIMM  BEEPER  DISCRETES  FROM  CAB  0  OR  I 


CONTROL  SYSTEM  TYPE:  RATE  COM/ ATT.  HOLD 

PURE  RATE  COMMAND 
ATT.  COM. /ATT.  HOLD. 
DIRECTIONAL  CONTROL  SYSTEM. 

CRAFT  CONFIGURATION:  UH60,  AH IS  OR  LHX . 


C 

C******************************************************* 
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non 


i 


C*****************  EXECUTABLE  CODE  **************** 
C******************************************************* 
C 

C .  BEEPER  TRIM  DRIVE 

C 

C . DISCRETE  TRIM  BEEPERS  ON  CYCLIC  INTEGRATE 

C . TRIM  POSITIONS 


TRIM1C  -  TRIM1C 
TRIM2C  -  TRIM2C 


GRLD*( IRWD 
GNUD*(IANU 


ILWD)*DT2 

IAND)*DT2 


C 

C 

C 

C 


C- 

C 


MAG  BRAKE 


CYCLIC 
TO  LATCH 


C .  IMBC  IS  MOMENTARY  SWITCH  ON 

C . WHICH  CAUSES  CONTROL  FORCES 

C . ON  OR  OFF 

C 

C 

C . IF  MAG  BRAKE  BUTTON  DEPRESSED  FIRST  TIME  THIS 

C . CYCLE,  TOGGLE  MODE 

C 

IF(  (IMBC  .EQ.  1)  .AND.  (IMBCP  .EQ.  0)  ) 

IMB  -  1  -  IMB 
IMBCP  -  IMBC 
C 


•FLOATING  MAG  BRAKE  VARIABLE 


FIMB  -  IMB 


C 

C 

C- 

C- 

C 


-IF  MAG  BRAKE  ENGAGED,  SET  TRIM  POINT 
-TO  CURRENT  POSITION(NO  APPARENT  FORCE) 


930 


I F( IMB  .EQ.  0)  GO  TO  930 
TRIM1C  -  ROLLOP 
TRIM2C  =  PITCHOP 
TRIM3C  =  YAWOP 
CONTINUE 


C 

C 

C 

C- 

C 

C 

C 


CONTINUE 

RETURN 

END 


